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I. INTRODUCTION 



Aeronautical applications have provided much of both the motivation and re- 
sources for recent advances in the field of controls engineering. In the quest for 
ever improving performance, the field of aerodynamics matured to the point that 
only incremental gains were possible. Consequently, the thrust for improved perfor- 
mance turned instead to more innovative ways of controlling air vehicles — allowing 
for unstable open-loop dynamics, shrinking control surfaces, and eliminating mechan- 
ical command systems in favor of “fly-by-wire” systems. These innovations in con- 
trols permitted the industry to exploit innovation in aerodynamics. The multi-input 
multi-output (MIMO) nature of flight dynamics, which severely taxed the methods 
of classical control design, and the fiscal resources available as a consequence of the 
industry’s vitality, fueled the development of the tools which for the moment are re- 
ferred to as “Modern Control.” Included in the list of the most recent tools available 
to the controls designer are controllers which are designed through the solution of 
convex optimization problems. The first general objective of this research was to 
demonstrate a methodology of how these theoretical advances can be implemented in 
aeronautical applications. 

The second phase of the research then built upon the first, and capitalized on 
the very recent convergence of several technologies. As suggested above, the pursuit 
for performance has led both the commercial and military aircraft industries into 
the realm of Relaxed Static Stability (RSS) aircraft. The benefits include enhanced 
maneuverability, lower drag, lower weight, and lower cost. Reduced static stability 
is achieved, in large part, by shrinking or eliminating surfaces or physical features 
whose sole purpose is to provide either control power or static stability. Consider- 
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able industry and government attention has been focused on the question of how 
one quantifies the thresholds for satisfactory dynamic performance. A dramatic re- 
vision to the traditional flying qualities specifications, from MIL-S785C [Ref. 1] to 
MIL- 1797 [Ref. 2] was principally in response to these types of issues. An ongoing 
NASA/Navy research effort has for several years been trying to quantify thresholds 
and metrics for satisfactory dynamic response [Ref. 3, 4]. Note, however, that the 
focus has been establishing metrics for satisfactory flying qualities (the dynamic be- 
havior observed by the aircrew). One published research effort (not associated with 
a specific airframe) has concentrated on the task of translating the flying qualities 
requirements into the domain of vehicle and controls design [Ref. 5]. In this 1987 
study, the absence of both an appropriate theoretical framework and the requisite op- 
timization tools constrained the controls design approach to classical methods. The 
very recent convergence of three key technologies: (1) the theoretical formulation of 
many controls problems as convex or affine optimization problems, (2) the develop- 
ment of efficient numerical methods for the solution of convex or affine optimization 
problems, and (3) the computational capacity of modern engineering workstations to 
execute such routines, now permits the formulation of these vehicle and controller 
design problems to be posed as tractable constrained optimization problems. This 
report proposes a theoretical formulation and demonstrates a methodology by which 
not only a vehicle’s control system, but the physical configuration of the vehicle itself, 
may be posed as a tractable constrained optimization problem. 

In the pursuit of the above general objectives, the research effort was comprised 
of three projects. The first involved simply the use of available commercial designs 
tools. The second involved the creation of controller design tools based on recent the- 
oretical formulations, and then their application to a simple design problem. Finally, 
the third area, the optimization of vehicle control power characteristics required the 
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development of a theoretical formulation, the creation of the appropriate design tools, 
and then their application to simple design examples to illustrate the viability of the 
methodology. Though these three efforts may only seem loosely related, each of the 
first two projects had elements which were critical to the subsequent project(s). The 
next section provides an overview of each project and its specific objectives. 

A. SPECIFIC OBJECTIVES 

The first problem was pure design for the autoland control system of a 

P-14 aircraft. The F-14 is a carrier-based fighter manufactured by Grumman Corpo- 
ration, and was selected for various examples within this study because of the unique 
configuration of its control surfaces. This effort had several specific objectives: 

1. Investigate how control could be utilized to incorporate the F-14’s Direct 

Lift Control (DLC) in the autoland problem. DLC is a powerful aerodynamic 
control surface which can directly decrease or increase the lift generated by t he 
wing by the symmetric deflection/ retraction of over- wing spoilers. The DLC 
is currently dormant in the F-ld’s autoland configuration. 

2. Further develop and demonstrate a methodology whereby scalar weighting func- 
tions could be used to tune an Hoo controller to meet classical performance 
requirements, including sensor band widths. This was an extension of the work 
of other authors [Ref. 6, 7, 8, 9, 10]. 

3. Introduce a methodology for the robustness analysis of nonlinear air vehicles. 

The design and analysis tools used here were commercially available, and the principal 
contribution of this section was the demonstration of a methodology for their use. 
Though convex methods were not applied in this problem, the development of the 
methodology was necessary as a foundation for the second problem. 
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The second phase of the work was a mixed 7i 2 / T'foo controller design example. 
Again the F-14 autoland controller design problem was chosen. The objectives of this 
phase included: 

1. Development of the computational design tools which could solve the continuous 
and discrete time 7i 2 / 'Hoo controller design problem. These problems had 
previously been theoretically posed by Rotea, Khargonekar, and Kaminer as 
convex optimization problems [Ref. 11, 12]. 

2. Demonstrate a methodology for the use of mixed 'H 2 / 7Yoo controllers. It 
was assumed at the outset that the methodology would be a derivative of the 
methodology demonstrated in the first design problem. 

This phase of the work provided the modeling skills and convex optimization skills 
which were necessary for the pursuit of the final phase of the research. 

With the first two projects complete, the foundations were in place to pursue 
the principal objective. The appropriate sizing of aerodynamic control surfaces is 
a current issue as the result of the trend towards Relaxed Static Stability (RSS) 
aircraft. The methodology in practice today is for the aerodynamic configuration 
designer to provide a controls designer with a configuration for which he is to design 
a controller that will hopefully satisfy the specified open-loop and closed-loop perfor- 
mance requirements. The controls designer only influences the configuration in the 
sense that if there is inadequate control power to achieve the desired flying qualities, 
the design is sent back to the configuration designer to provide more control power. 
Absent is a method by which the performance requirements can directly be trans- 
lated into an optimal configuration along with an accompanying feasible controller. 
Given that many common performance specifications are convex, the question posed 
was: “Is it possible, to formulate a convex controller design problem in which not 
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just the controller, but the plant itself is optimized?” We will refer to this as the 
plant/controller optimization problem . The final phase of the research consequently 
had three objectives: 

1. Determine a theoretical formulation for the plant/controller optimization prob- 
lem. 

2. Design the computational tools necessary to implement the proposed solution. 

3. Create multiple design examples to illustrate and validate the proposed solution. 

B. REPORT ORGANIZATION 

The report is organized so as to separate the discussion of computation issues 
from the engineering issues. Consequently, the main body of the report exclusively 
discusses either theoretical issues or their applications. The computer codes and their 
relevant discussions are then found in the various appendices. 

The main body begins with an overview of the tools and theory which were 
then applied in pursuit of the above objectives. Chapter II presents a short discus- 
sion of convex optimization, and outlines the two numerical algorithms which were 
used to solve the convex optimization problems which occur in the report. Chapter 
III then presents the theoretical controls background upon which the research drew. 
Most important is the outline of convex and affine expressions for various control 
design problems. Because of the similarity of the two problems, Chapter IV presents 
the details of both the 7 and mixed 7-f 2 / 7 design problems. This includes 
a description of the problem to be solved, and the methodology for both the syn- 
thesis and analysis of the resulting controllers. In both cases, a simulation exercise 
was performed to verify that the controller demonstrated the desired characteristics. 
Chapter V then presents a methodology by which the plant/controller optimization 
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problem can be formulated as Linear Matrix Inequalities (LMI’s). This formulation 
then permits the solution of the problem by convex methods. This chapter also in- 
cludes a number of examples demonstrating how various types of specifications can 
be accommodated by this methodology. Finally, Chapter VI provides a summary of 
the conclusions and recommendations of the report. 

The appendices form the balance of the report and include the final versions 
of the various computer codes used to generate the results found in the main body. 
MATLAB was used for all the programming, and so the codes are written either 
as function files, or m-file scripts. Appendix A presents the derivation and listing 
of the codes which were used to solve the continuous and discrete time 
controller design problems. Appendix B provides the materials which supported the 
two F-14 design example problems. This includes the SIMULINK models used both 
to form the synthesis model and perform the nonlinear simulation. The scripts used 
to perform/analyze the design are also listed. Next, Appendix C presents a listing of 
the interior point codes which were used to solve those problems posed as LMFs. The 
original versions of these codes were written at the University of Michigan, and were 
provided by Professor Pramod Khargonekar. They were then substantially modified 
by this author to improve their numerical efficiency and reliability. Finally, Appendix 
D presents the function files and scripts which were used to support and illustrate 
the plant/controller optimization material of Chapter V. 
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II. CONVEX OPTIMIZATION 



This chapter provides essential background material on the general classes of 
problems which were considered, and outlines the tools available for solving these 
problems. The first section reviews the foundational mathematical definitions. Fa- 
miliarity with these terms and relationships is a prerequisite, as they occur repeatedly 
throughout the report, and in part define the scope of this report. Next, the second 
section provides a brief overview of the two numerical tools which were applied in 
solving the various example problems. 

The following notational conventions will be observed in this report. Greek 
letters represent scalars or scalar valued functions (e.g. A 6 R or (p{x ) : R n — ► R). 
Lower case letters represent vectors (e.g. x E R n ), with a subscript ? indicating 
the zth element. Lastly, uppercase letters represent either matrices or matrix valued 
functions (e.g. Y € R nXm or F(x). Pairs of subscripts on a matrix are the indices 
for a particular element of the matrix. A single subscript on a matrix indicates a 
particular matrix in a set of matrices. Additional notation will be introduced later, 
when flight dynamics conventions prevail. 

A. DEFINITIONS 

1. General 

In general, the optimization problems considered during this research were 
of the form: 

Given the vector space R n , and the scalar valued functions d>(x) : R n — » R 
and xf{x) : R n — > R, find x opt ER r \ such that 0(.r) is minimized , subject 
to x ) < 0. 
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The function V’( a ') is referred to as the constraint function , and if ?/>(s) < 0, then 
s e R n is referred to as a feasible solution. The function <t>{x) is referred to as 
either the objective function or cost function . In practice, a (sub)optimal search 
was performed to find a x su b GR n such that (j>(x su &) — </>(x op< ) < v , where v was an 
arbitrarily small stopping criteria. 

The following mathematical definitions are important in describing various 
types of functionals. The definitions are extracted from [Ref. 13], but are standard 
across the literature. Consider the set X G R n . 

Definition 2.1 The set X is “affine," if for any x, x GX and any A G R, Ax + (1 — 
A)x G X. 

Definition 2.2The set X is “convex," if for any x, x G X and any A G [0, l] ; 
Xx + (l — X)x G X. 

Definition 2.3 The functional <j> : X — * R is “affine/ 7 if for any x, x G X and any 
A G R, <f)(\x + (1 — A)x) < \<j)(x) + (1 — A)<j!>(t). 

Definition 2AThe functional <j) : X — > R is “convex," if for any x, x G X and any 
A G [0, 1], <j>{ Xx + (1 - X)x) < X </>(x) + (1 - X)<j>{x). 

Definition 2.5The functional <j) on the convex set X is “quasi-convex , " if for any 
x, x GX and any X G [0, 1], <t>( Ax + (1 — A)x) < max(<j>(x), </>(x))* 

The following relationships can be deduced from the definitions: 

1. an affine set is convex , 

2. an affine functional is convex , 

3. a convex functional is quasi-convex, 

4. the reciprocal of an affine function is affine. 
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The most significant fact relating convex sets and ( quasi )con vex functionals 
is that if 0(*r) is (quasi)convex, and a £ R, then the set X containing all x, such 
that 0(:r) < a, is convex. Similarly, if 0 is affine and a € R. then the set X 
containing all x , such that 0(x) < a, is affine. These are referred to as functional 
inequality specifications. The practical significance of quasi-convex functionals and 
the convex sets represented by a functional inequality specification is that one is 
guaranteed to find the global minimum of an objective function to within a numerical 
threshold. Furthermore, if the set is bounded, then the argument minimizing the 
objective function can also be isolated. The advantage of convex functionals over 
those that are quasi-convex is the facility with which lower bounds can be computed 
during the optimization process, resulting in straightforward termination criteria. 
The reference [Ref. 13] contains additional information on the properties of convex 
sets and functionals, as well as illustrations and alternative tests for convexity. The 
optimization problem described above is a (quasi )convex optimization problem if the 
set satisfying the constraining functional inequality specification is convex, and the 
objective function is (quasi)convex. 

The optimization problem described above prescribed that the constraint 
functional 0(.r) be scalar. Many of the constraint functionals encountered in this 
report will be matrix inequalities of the form: H(x) = H T (x) < 0. This is math- 
ematically equivalent to the scalar functional inequality: A maT (//(x)) < 0. Conse- 
quently, we can use the functional matrix inequality to notationally represent the 
scalar constraint:A majr (//(x)) < 0. Within all of the numerical algorithms applied 
here, it is the scalar constraint that is enforced. 

2. Linear Matrix Inequalities 

Consider the set of square, symmetric matrices F 0 , Fj, . . . , F n , where F t — 
F T e R m x m ^ for all • 
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Definition 2.6 7 7/e functional inequality F(x) > 0, x £R n , is a Linear Matrix In- 
equality (LMI), if it can be posed in the form F(x) = Fo + £^=1 x t F t > 0. 

Note that the functional 4>{x) = A mar ( — F(x)) is affine. Consequently, the LMI , 
F(x) > 0, represents an affine functional inequality specification. Though the above 
mathematical definition of affine only pertains to scalar functions, it is extended it 
to include all matrix-valued functions of the form F(x ) = Fo -f x,F,. In this 
context, we refer to F(x) as affine in x. 

Several forms of optimization problems exist involving LMI’s. The two 
problems of interest here are the Generalized Eigenvalue Problem (GEVP), and the 
Eigenvalue Problem(EVP). Let /l(.r), B(x). and C(x ) be symmetric matrix-valued 
affine functions of x. The GEVP is defined as follows: 



Minimize: A 

Subject to: \B(x) — /1(t) > 0,7?(:r) > 0, and C(x ) > 0. (2.1) 



The EVP is the simplified case where B(x) = /. The important distinction between 
the two classes of problems is that the EVP is a convex optimization problem, while 
the GEVP is quasi-convex (see [Ref. 14]). 

3. Schur Complements 

The following lemma will be very helpful in reformulating various matrix 
inequalities. 

Lemma 2.7 (Schur Complements ) Let Q, S, and R be matrices of compatible 
dimensions. Suppose Q — Q T , and S — S T . Then the following two statements are 
equivalent: 



1. 



Q R 

R T S 



> 0 . 



2. Q > 0, S' > 0, and Q - RS~' R T > 0. 
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Specifically, Schur complements are the means by which many of the Riccati 
inequalities common to modern control theory can be reformulated as LMI’s. 

B. NUMERICAL ALGORITHMS FOR THE SOLUTION OF CONVEX 
OPTIMIZATION PROBLEMS 

Two numerical algorithms were used to solve the convex optimization problems 
of this research. At the point at which the research was undertaken, two princi- 
ple numerical tools were available to pursue convex optimization problems: Kelly's 
cutting plane methods, and the Ellipsoid algorithm. The Ellipsoid algorithm was 
chosen both for it’s ease of implementation, and its attributes regarding problem size. 
Kelly's cutting plane methods were rejected due to a concern about the growth of the 
data storage requirements for the size problems being considered. Shortly after the 
implementation of the Ellipsoidal codes for several problems. Interior Point methods 
began to mature and receive substantial attention in the controls community. These 
latter methods are applicable only to those convex optimizat ion problems which can 
be posed as LMI's, but are reputed to converge much more quickly than the previous 
methods. In each case, Professor Stephen Boyd of Stanford University was the prin- 
cipal figure responsible for the popularization of these tools in the context of control 
theory applications. 

This section provides a brief discussion of both of these methods. Only those 
details relevant to our specific implementation are addressed, as both these methods 
were regarded as means to an end. Details and convergence proofs, as well as further 
references regarding the history of these methods can be found in [Ref. 13, 14, 15]. 

1. Ellipsoidal Algorithm 

The ellipsoidal algorithm is suitable for use in all quasi-convex optimization 
procedures, including LMI's, and is mathematically guaranteed to find a optimum 
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solution to within a specified threshold. First of all, consider a problem in which 
one is simply trying to optimize an objective function (f>(x ) without any constraints. 
Consider Figure 2.1. At each iteration A - , the search is characterized by a vector 
jib £ R", and an ellipsoid E^ centered about .A k \ whose size and orientation are 
defined by the positive definite matrix A^ € R nxn (the eigenvalues of A^ are the 
square of the magnitudes of the respective semi-axes of E^ k \ while the eigenvectors 
of are their orientations). Assume that optimum point is located within E^ k \ 

and let the gradient vector g be defined: .... If <p(x( k )) = a, then <f>(x ) 

convex implies that 4>(x) > o for all .r in that half of E ^ in the direction of g^ k \ 
The optimum point must then lie in the other half of E^ k K and the half in the </*> 
direction may be discarded from the search. Consequently, each iteration finds a 
new ellipsoid defined by (x^ k+1 K /P* + B), which completely contains the entire half- 
ellipsoid bounded by {{x^ k \ A*^), and the hyper-plane orthogonal to g^ k \ in the — </0 
direction (the shaded area of Figure 2.1). The process is then repeated. Though the 
ellipsoid may elongate, the volume of the ellipsoid shrinks at a constant rate with 
each iteration, until the optimum point is isolated to suitable precision. Preferably, 
the ellipsoid should be initialized such that it includes the optimal point, though it 
is reportedly possible for the ellipsoid to migrate to capture the optimal point [Ref. 
13], 

This mechanism works equally well for constrained optimization problems. 
For the constrained problem, the new ellipsoid is used to either further isolate the 
feasible set defined by the constraint functional inequality, V’( r ) < 0? or reduce the 
cost function <f>(x). The algorithm progresses as follows: 



1. Evaluate t/>(.r^). 



2. If .tC) is infeasible (V’(.'r^) > 0), then find the gradient g^ 



dx 




By 
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Figure 2.1: Graphical Depiction of the Ellipsoidal Algorithm 
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/ L\ 

eliminating the infeasible half-space in the direction g ^ , a new smaller ellipsoid 
(r(k +1 ), /f( fc+1 )) is determined. Provided that the search was initialized with a 
feasible point in the original ellipsoid, then all feasible points in are 

retained in A (fc+1 )). 



3. If is feasible < 0), then find the gradient g ^ {k) . Now the 

half space is eliminated for which the objective function has values greater than 
(</>(x^)), retaining in (x^+B, all of the feasible points having objective 
values less than (<£(x^)). 



4. Next iteration 

Note that any number of constraint functions 'ifti(x) could be considered sequentially 
in step 2 above. This structure is clearly apparent in the ellipsoidal codes in Appendix 
A (such as h2inf syn). 

The various formulae for updating the ellipsoid can be found in the codes 
and in [Ref. 13]. The principal challenge in applying ellipsoidal methods was the 
derivation of the appropriate subgradients of functions which were not strictly differ- 
entiable. 

In practice, a deep-cut modification to the above algorithm was used [Ref. 
13]. The principal here was to use the value x > 0 to shift the position of the 
hyper-plane in the —g^ direction so as to reject more of the infeasible space with 
each iteration, improving the speed of convergence. 

2. Interior Point Methods 

Interior point methods for the efficient numerical solution of LMI’s are 
generally attributed to Nesterov and Nemirovsky [Ref. 16]. Their application to 
problems of interest to the controls community was then popularized by Boyd and El 
Ghaoui [Ref. 14, 15]. 
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Unlike the Ellipsoidal algorithm outlined above, the Interior Point algo- 
rithm is restricted to those optimization problems which can be posed as LMI’s. 
Computationally, the interior point methods are superior to each of the other meth- 
ods in part because the search is restricted to the feasible set (hence Interior Point), 
whereas both the Ellipsoidal and Cutting-Plane methods can exhaust tremendous 
amounts of computational energy ori isolating the feasible set. Only a brief overview 
of the method is presented here, and the reader is referred to [Ref. 14, 15] for more 
thorough coverage. 

Consider the EVP above. By including A as the first element of the vector 
x (i.e. x ~ [ A x T ] T ), and letting c — [1, 0, .... 0], the EVP can be reformulated: 



• • • T 

Minimize: A = c x 
Subject to: F(x) := 



XI - A(x) 

C(t) 



> 0 . 



Let A* fc * represent an upper- bound on A for iteration k. Let \ opt represent 
the optimal value of the EVP, such that for all A**)) > A opt , the LMI 

A<*>) - c T x 



F(x) 



> 0 , 



is feasible, i.e., there exists a vector x satisfying the LMI. If we assume that the LMI 
has a bounded feasible set, then the function 



(f> {k) (x) = log (det F(x) -I- log 



1 



A< p > - 



c 1 r 



(2.2) 



has a global minimum within the bounded set since both terms are convex functions 
of x. The first term of (t>(x) is a boundary function because its value goes to infinity 
as the boundary of the set {x : F(x) > 0} is approached. It is this property that is 
used to keep the search within the feasible set. The choice of boundary function is not 
unique, and while it is unusual to find the determinant in a computational routine, 
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it is used here because both the gradient and Hessian of the boundary function are 
easily computed, and calculation of (j>{x) itself is not required. The analytic center of 
<^>(;r,A) is denoted as ar*(A^), and defined by: 

r-(A (t| ) := argmin, (log (det F(x,\)~') + log ^ 3 - ^ ) ■ (2.3) 

The Interior Point method used here is based on the method of centers and 
is comprised of two nested loops. In the inner loop, given A^, the analytic center 
can be found by Newton’s method. In the outer loop, is decreased with 
each iteration, and the search for x*(AU' + U) is initialized at x*(A^)). Algorithmically: 



1 . Initialize the problem at k = 0, with some feasible x^ 0 * and A* 0 *, such that: 

A(°))-c r x(°) 



F(x<°>) 



> 0 , 



2. Update A* fc b 



A u+u = (i -e)c T x (k) + o\ (k) . 



(2.4) 



3. Find the analytic center x*(A* fc+ U) by Newton’s method. 

4. Update x^h 

x (k+1) = x'(A (fc+1) ), (2.5) 



5. Next k. Return to step 2 until termination criteria satisfied. 

The variable 0 6 ( 0 , 1 ) is a computational parameter, with 0 typically small. Note 

that the second term of <f>(x) in 2.2 is singular if 0 — 0. In the outer loop, x**’* 

represents the set of analytic centers, which is described as the path of centers , hence 

the method is referred to as the method of centers. 

Define the gradient ( g ) and Hessian (//) of <f) to be: 

g(x) := ( a vector) 

//(x) := ( a matrix). 

The following algorithm outlines the Newton search for the analytic center, x“(A^*): 
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1. Initialize the Newton search with = x^ k K 

2. Calculate each element of the gradient and Hessian of (j) at 



g t (x {k ' l] ) 

Mai*™) 



tr (F(t {U) )~ 1 F t ) + 
tr (F(a- (U) )- 1 F,F(a- 



c. 

A(*> - c T :r< A -'> 






CiCj 

(A<*> _ c T x (k,l)y 



( 2 . 6 ) 

(2.7) 



3. Determine the Newton decrement, <$, and the damping factor, o: 






g(x^ k '^) T H (t 

f 1 if<5(T (A -')) < 0.25 

i 1/(1 + 6(x<*-'>)) if<5(T< A ’ () ) > 0.25 ' 



( 2 . 8 ) 

(2.9) 



4. Update the search: 



jtW+D 



x(A-, /) - a(x (U) )/7(x (A ’ ,) )- , ^(x (U) ). 



( 2 . 10 ) 



5. Next /. Return to step 2, unless termination criteria satisfied. 

6. x*(AW) = rW) 

Details regarding the algorithm, including convergence proofs, termination criteria, 
and modifications, can be found in the above references. The interior point routines 
used for this research are discussed and documented in Appendix C. It is important to 
note that these routines are not problem specific but are suitable for solving any prob- 
lem which has been posed as a GEVP (EVP). Once the problem is so posed, then the 
interior point algorithm requires only the three sets of basis matrices {/to, Aj, . . . , A n }, 
{£o,£i B n }, and {Co.C, C n }. 
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III. THEORETICAL BACKGROUND 



A wide range of interesting and powerful control problems can now be solved and 
applied as the result of recent advances in computational methods, computer capacity 
and theoretical control. The previous chapter outlined several of these computational 
tools. This chapter provides the theoretical background for the control design and 
analysis tools implemented in this report. 

Consider the multiple input multiple output (MIMO) feedback system depicted 
in Figure 3.1. For the purposes of this chapter, we shall consider only finite dimen- 
sional linear time invariant systems. The general problem of control design is: Given 




Figure 3.1: Standard-Feedback Configuration. 

Q , find C such that the closed-loop system T(Q ,C ) is internally stable, and such that 
the output vector z has some specified desirable character in response to either the 
input vector or some specified set of initial conditions. It has long been recognized 
that many traditional control problems, such as solutions to Lyapunov’s Equation, 
can be posed as a convex optimization problems. It is only with recent improvements 
in computational capacity (hard and soft), that these problems have become numer- 
ically tractable. Simultaneous with the increase in computational capacity came the 
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realization that many other desirable control problems could likewise be posed as 
convex optimization problems. 

Initially, this chapter outlines several control problems which can be expressed 
as convex optimization problems. First, the 'He*, control problem will be defined 
and discussed. The pure Hoo problem can be more rapidly solved by methods other 
than convex optimization, but its convex forms allow for several derivative problems 
of interest. Furthermore, it is the convex form that allows Hoc to be used as the 
foundation for solutions to the plant/controller optimization problem. Next, the 
mixed H 2 / 'Hoc control problem (continuous and discrete time) will be discussed and 
outlined. Third, a convex constraint for closed-loop pole locations will be presented. 

After the presentation of the control design tools, the small gain theorems and 
the structured singular value will be discussed. By themselves, these are not design, 
but robustness analysis tools, and while not explicitly part of the convex optimization 
process, they can serve as a guide in formulating a synthesis model to design for 
robustness. 

A. Hoo CONTROL 

1. The oo Norm 

Consider again the feedback system depicted in Figure 3.1. Let T ZW (Q , C ) 
denote the closed-loop transfer function matrix from the input vector w of exogenous 
signals, to the output vector z of errors. Then the infinity norm of T ZW (Q , C ) is 
defined as the supremum over all frequencies of its largest singular value: 

II T ZW {Q ,C ) ||oo:= sup{a(T zw (ju))}, 
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where a denotes the maximum singular value of T. This is an induced norm from w 
to z, which can alternatively be expressed. 



|| T zw (0 ,C ) ||oo= sup{ || r || 2 :|| w || 2 < 1}. 



An interesting physical interpretation is that || T ZW {Q ,C ) Hoo represents the peak 
power gain from tv to z [Ref. 17]: 

II T ZW (Q ,C ) ||°o= su p{^^}> 

where: 

pow(tv) := J_ T w ( l ) 2dt 

The power interpretation clearly illustrates one of the many motivations behind the 
attention TYoo work has received during the past decade. It is this property which 
will be exploited later, as specifications abound where a specified rms output level 
is permitted for a specified rms disturbance input. For example, the Dry den model 
of air turbulence specifies various levels of turbulence with rms amplitudes. This 
property of the norm permits us to pose many typical disturbance rejection 

specifications as control problems. 

Consider the following state-space representation of the closed-loop system: 




r 2 , 



x = Fx + Gw 
z = Hx + Jw 



(3.1) 



where F is stable. It is well known [Ref. 18] that || T zw ||oo< 7. if and only if there 
exists a real symmetric matrix, V > 0, such that: 



FY + YF t + (YH t + CJ T )(y 2 I - JJ T )~ l (IIY + JG T ) + GG T = 0. (3.2) 



This Riccati equation is referred to as the "Hoo analysis equation. 
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2 . (Sub)Optimal Hoo Output-Feedback Control by Riccati Methods 

The Woo (sub)optimal control synthesis problem is to find, among all con- 
trollers that yield a stable closed-loop system, a controller C that minimizes || T ZW (Q ,C) ||oo. 
Recent work [Ref. 18, 19, 20, 21, 22] has led to a simple and elegant approach to this 
problem. 

Suppose that a continuous time state-space realization for the plant Q depicted 
in Figure 3.1 can be written as 



G = 




Ax + Bi w + B 2 n 
C\ x + D i u 
C 2 x + D 2 w 



(3.3) 



Assume that (C 2 , A, B 2 ) is stabilizable and detectable, that D\ has linearly indepen- 
dent columns, and that D 2 has linearly independent rows. Recall that a Hamiltonian 
matrix is a matrix H of the form: 



H 



P R 
Q -P' ' 



where P,Q and R are real ?? x n matrices with Q and R symmetric. If such a 
matrix H has no imaginary eigenvalues, then the spectral snbspace \_(//) spanned 
by the generalized eigenvectors belonging to eigenvalues lying in the open left lialf- 

-V, 



plane is of dimension n. Let the columns of " denote a basis for the subspace 

A2 

\_(//). We will say that the Hamiltonian matrix H belongs to (lom(Ric) if H has 
110 imaginary eigenvalues, and if Ah is nonsingular. If // belongs to dom(Ric ), define 
Ric(II) := Ah Ah -1 =: AT It is well known that A is symmetric, P + RX is stable, 
and X satisfies the algebraic Riccati equation: 



P'X + XP + X RX -<2 = 0. 



1 lie key mathematical result on Ploo synthesis by Riccati methods is stated below. 
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Theorem 3.1 Consider the system 3 . 3 . Suppose 



and 



rank 



rank 



$sl - A 


b 2 ' 


-Ci 


A . 


si - A 


Bt ' 


1 


d 2 J 



= n + rank( D \ ), Vs = juj. 



= n + rank(D2), Vs = ju:. 



and let 7 > 0 be a given positive number. Define 

H(l) = 



A - B 2 ( D\ D x )~'D\C , 7 ~ 2 B, B\ - B 2 (D\ D x )~ l l % 

-C[(I -D,{D\D,)-'D\)C, -A' + C[D x {D\D x )-'B ' 2 



and, 



A' - C'(D 2 D' 2 )- l D 2 B' y~ 2 C[C x - C'(D 2 D' 7 )~ l C 2 
-C ,(7 - D' 2 {D 2 D' 2 )-' D 2 )B\ -A + B 1 D 1 (D 2 D 2 )~ 1 C 2 



J( 7 ) = 

There exists a stabilizing controller C such that HT^Hoo <7 7/ a7irf 077/7/ ?/ 
/. // (7 ) € r/o 7 ??(/??c) and .V ( 7 ) := /??’c(//(7)) ?’s positive semidefinite. 

2 . J(7) € dora(/??’c) and V’(7) := Ric(J( 7)) 75 positive semidefinite. 

3 . p(X (~f)Y (7)) < 7 2 , where p denotes the spectral radius. 

Then such a controller , C , is given by: 

n _ \ I ~ + Zoo^ooCfi T 

1 U = -Bj Xcot 



when 



/loo := A + y^B.BjXoo- B.BjX^- Z^CjC, 
^00 := 



( 3 . 4 ) 



( 3 . 5 ) 

( 3 . 6 ) 



Existence and computation of A (7) and V (7) are standard matrix algebra 
problems that can be solved using a standard technique for solving Riccati equations 
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based on the real Schur decomposition [Ref. 23]. The pair of Riccati equations associ- 
ated with //( 7 ) and J( 7 ) are referred to as the 7 synthesis equations. Specifically, 
the Riccati equation associated with //( 7 ) is the state-feedback synthesis equation, 
while J( 7 ) is associated with is the 7Yco filtering equation. 

Commercial software is available from several sources which implements 
this theorem to determine a suitable controller from the input state-space model 
[Ref. 24]. In practice, implementations of this theorem usually start with an arbi- 
trary upper bound 7 U on the achievable performance. The theorem is then used to 
perform a binary search in the interval [0, 7 ^] for the optimal value of 7 . If 7 ^ proves 
infeasible, then it can be set arbitrarily higher. Once the binary search has deter- 
mined a sufficiently small interval in which the optimal value of 7 must lie, the search 
is stopped and a (sub)optimal controller C is computed using the right endpoint of 
this interval for 7 in the formulae above. Controllers determined by this means are 
usually referred to as the central controller. These methods are not perfectly clean 
numerically, as in practice, .V and Y must be allowed to have very small negative 
eigenvalues. 

3. State-Feedback Synthesis by Convex Methods 

In this section, extracted largely from [Ref. 25], we show that the fractional 
representation of memoryless (i.e., static) state-feedback controllers, i,e. I\ — WY~ l , 
where } > 0 , can be used to reduce the state-feedback control optimization 

problem to a convex feasibility problem over the space of finite-dimensional real ma- 
trices. This fractional representation was first introduced by [Ref. 26], and will be 
used extensively throughout this report. 

In order to introduce this parameterization, we first answer the following 
question. Given a plant, Q , with all the states available for feedback, characterize 
the set Am{Q ) of all stabilizing memoryless state-feedback controllers. Suppose the 
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plant Q is represented by the following equations 

{ .r = Ax -f B\w + B 2 u 

z = C \ .r 4* D\ii (3.7) 

V = 

where x £ R n , u £ R q and z € R p ■ Let E denote the set of all real n x n symmetric 
matrices, and define 

Q := {(IT, Y) <E R qxn x E : Y > o} (3.8) 

Note that $1 is a strictly convex open subset of Ri xn x E 
We now make the following assumption: 

A\. The pair (A, B 2 ) is stabilizable. 

Assumption A 1 is necessary to guarantee that A m {Q ) is not empty. 

Theorem 3.2 Let Q be given by equation (3.7). Define 

L(W , T) := AY + YA' + B 2 W + W'B' 2 . (3.9) 

Consider the set 

:= {(IK Y) € n : A (ITT) < 0}. 

Then A m {Q ) is nonempty if and only if 4> m is nonempty. In this case < 1 ) m is convex 
and the mapping 

<p:$m ->A m (G ): (IT,T)~ WY-' 

is onto. 

Proof. Suppose A 6 A m {Q ). Then it follows from Liapunov stability 
theory that there exists Y > 0 such that 

{A + B 2 K)Y + Y(A + B 2 K)' < 0. (3.10) 

Set IT — A T in (3.10) to get (3.9). 
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Conversely, suppose (IT, V) 6 Set K — WY~ X in (3.9) to get (3.10). 
Finally, convexity of ^> m follows from the convexity of the mapping V — > 
L(Y), which is linear and, hence, affine and convex. ■ 

Next, we proceed to similarly parametrize the set of all memoryless stabi- 
lizing state-feedback controllers, which also make the infinity norm of the closed-loop 
transfer function 

\\T ZW (G, K)\\<x> less than a given number 7 > 0 . We denote this set *4oo,m(£ )• The 
importance of this theorem is in the fact that it parametrizes Aoo.miG ) in terms of a 
set of solutions to a convex QMI (quadratic matrix inequality). 

Theorem 3.3 Let Q be given by equation (3.7) and let 7 > 0. Define 

R(W, Y) := AY+YA'+B 2 W+\V , B , 2 +(C i Y+D l YVy(C l Y+D l \V)+B l B[/ 1 2 . (3.11) 

Consider the set 

<*Voo := {(W,Y) € n : R(W.Y) < 0}. 

Then Aoo,rn{G ) is nonempty , if and only if <£ moo is nonempty. In this case 4> mf00 is 
convex and the mapping 

9 : $m.oo - A* ,m(Q ) '■ (W, Y) ~ WY~' 

is onto. 

Proof. Without loss of generality assume 7 = 1 . Suppose I\ G Ar^^G ) is 
given. Then, it follows that there exists Y > 0 such that the Tioo analysis inequality 
3.2 is satisfied: 

{A + B 2 I<)Y + Y(A + B 2 I<Y + Y(C\ + D x I < )'(Ci + D, K)Y + B X B\ < 0 . (3.12) 

Set W = I\Y in (3.12) to get (3.11) 

Conversely, suppose (IT,}') € ^ m ,co are given. Set K — IT }' -1 to get 
(3.12). Then it follows that K G *4oo,m(£ ). 
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The convexity of 4> miCO is proved in [Ref. 11]. ■ 

By Schur complements, inequality 3.11 is equivalent to the following LMI 



[Ref. 15, 20]: 



Ri(W,Y) 



AY + Y A! + B 2 W + W'B' 2 + B , B\ (CY + DW)' 
( CY+DW ) - 7 2 1 



< 0. (3.13) 



This LMI expression is superior to the QMI 3.11 in two respects. First of all, it is 
affine in the controller parameters IT and Y, Secondly, the LMI is also jointly affine 
in 7 2 . Consequently, while Riccati methods can only find a controller for a specified 
7 , and methods such as bisection are required to find the optimal 7 , convex methods 
using the LMI expression can find a (sub)optimal 7 and associated controller directly. 
Similar expressions exist for the output feedback synthesis problem [Ref. 27]. This 
LMI will figure critically in our formulation of the control power optimization problem. 



B. MIXED H 2 / Hoo CONTROL 

Multi-objective control, and most specifically, mixed H 2 / H^ control has re- 
ceived considerable attention in the controls literature in the past several years (see 
[Ref. 28, 12]) and references therein). This section presents the theoretical results 
which provide for the convex solution of the mixed problem in both continuous and 
discrete time cases. These results are largely extracted from [Ref. 28, 12 ]. 

1. Continuous Mixed H 2 / Hoo Control 

Consider the finite-dimensional linear time invariant (FDLTI) system de- 
picted by Figure 3.2. The objective of the underlying problem is, given Q , find C , 
such that the generalized H 2 cost of the closed-loop system. \\T ZgW (Q ,C ) || 2 y is min- 
imized, subject to the constraint that \\T Z]W (Q ,C ) ||oo < 7 - The generalized H 2 cost 
is defined as: 

lin,,|| 2 , := l//(T J^T,„Uu)T;JjuW»y (3.14) 
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Figure 3.2: The ?-f 2 / 'Woo Synthesis Framework. 

where /(•) can be either 1) the trace, 2) the maximum eigenvalue , or 3) the maximum 
diagonal element. The reader is referred to [Ref. 29] for a discussion of the attributes 
of these norms. 

Suppose AoO'miG ) is nonempty, i.e., a controller, C . exists such that 
|| T SIW (Q , C )|| OG < 7 . The set defined by ) » s then referred to as the set 

of feasible controllers. In [Ref. 28, 30], the authors introduce an associated cost, the 
mixed FL 2 / norm (|| • || 2 /oob which they prove is an upper bound to the gener- 

alized cost. The 7^2 / 'Hw problem can then be considered as a search over the 
set of feasible controllers for that controller which minimizes || T Zqw (Q , C )|| 2 /co' Fur- 
thermore, the determination of a controller, C , which minimizes \\7\ 0W (Q ,C )|| 2 /oo-> 
subject to \\T ZlW (Q ,C )||oo < 7 , is posed as the following convex optimization problem. 

Consider the following state-space representation of the closed-loop system 
T ZW (G ), where C is feasible: 



Q := 



x = Ft + Gw 
~u = H<jX + J 0 w 
~i = x + Jiw 



(3.15) 



We know from equation 3.2 that there exists a unique symmetric matrix V\ such t hat: 



FY + YF 1 + (YH{ + GJ{ )h*l ~ )~'W i V + W 1 ) + GG 1 - 0. 



Moreover, if L c is the controllability Grammian of the pair (F,G), then 0 < L c < Y . 
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The generalized mixed 7i 2 / Tioo cos/ of the closed loop system is t hen defined as: 




(3.16) 



Consider now the following state-space representation of Q : 



r x — Ax + B\W -f B 2 U 



z 0 — Cq\ X + Do\U 

Z\ — C\\x -f D\\U 
,y = C 2 x + D 2 \w 



(3.17) 



Let n := dim(x), and m := dim(n). Furthermore, assume that: (a) the triple 
(C 2 , A, B 2 ) is stabilizable and detectable, (b) the pair (A,B\) has no uncontrollable 
modes on the imaginary axis, and (c) D 2 \[Bj D — [0 /]. 

Suppose there exists a symmetric matrix Q > 0, satisfying the filter- 

ing equation: 



Define the auxiliary quantities: 

Aq = A + QCJ C, B 1Q := QCj B 2Q := B 2 + QCj D, , 

Let (W, V) G {W, Y : W € R mxn , Y E R nx ", Y = Y T > 0}. Finally, define: 

R(W, Y) := A q Y + YA t q + B 2Q W + W T Bj Q + B ]Q B l \Q T + 

{C\Y + D J2 W) t (C\Y + D\ 2 W) (3.19) 

M(W,Y) := C 0 QCZ + (C 0 Y + D 02 W)Y~'(C 0 Y + D 02 W) t . (3.20) 



AQ + QA t 4- Q{CjC, - CjC 2 )Q + B x Bj = 0. 



(3.18) 



Note that equation 3.19 is identical to 3.11. 



Let $ define the set of feasible solutions: 




(3.21) 



and consider the optimization problem 



a s := inf Y)) : (W, >') € <t>) . 



(3.22) 



Theorem 3.4 The set of feasible controllers , ), is not empty , if and only if: 

(1) A stabilizing solution Q > 0 exists to 3.18 , and (2) the set <f> is not empty. If a 
feasible controller exists , then 



Jj(T Z 0 AG X )) .= f(M(\V,Y)). 



Moreover , given any a > aj, there exists a solution , (IT, T) 6 $ sue// ///a/ f(M(W\ V )) < 
a, and the dynamic observer based controller 



n f £ — — C2O 

" 1 / = WY~ l Z 



(3.23) 



/s feasible and Jj{T Z qW (Q , C )) < a. 

Consequently, if a feasible controller exists, then the problem of finding a 
(sub) optimal controller for the TL 2 / Tt^ problem can be reduced to the solution 
of a Riccati equation (3.18), and the numerical solution to the convex optimization 
problem: 



Minimize: /(A/(IT,T)), over (IT, Y) 6 R mxn x R” x \ 

Subject to: R(W,Y) < 0, and Y = V T > 0. 

The solution to the state-feedback problem (C 2 = /, D 2 \ — 0) can be simply posed 
by eliminating consideration of the filtering equation (3.18), and replacing Aq = A , 
U\q — /?i, and B 2 Q = i ?2 in the expressions for /?(IV, V ) and A/ (IK, V) above. The 
controller is then C = I\ 9 jb = IT T -1 . 

The ellipsoidal method was chosen to code a MATLAB function file which 
solved the state-feedback design problem. A second routine was also written which 
solved the measurement-feedback problem by solving the filtering equation (3.18) by 
Riccati methods, replacing the state-feedback variables with the appropriate auxiliary 
plant variables, and then calling the state-feedback design function. Both of these 
codes and their supporting subroutines are developed and then outlined in Appendix 



A. 
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It is a straightforward mat ter to use Schur complements to pose each of the 
above matrix valued inequalities, 3.19 and 3.20 as LMI’s. Consequently, the numerical 
problem could also have been solved by the interior point method. 

2. Discrete Mixed H 2 / Hoo Control 

This section presents the theoretical results of [Ref. 12], which pose the 

K 

discrete 7 -i 2 / 'Hoo controller design problem as a convex optimization problem. The 
discrete time H 2 / H 0 0 problem differs only slightly from the continuous time problem 
above. The most significant difference is that it is structured about full-information 
feedback for an auxiliary plant rather than a state-feedback solution. 

First of all, the definitions of the respective norms are predictably similar 
to their continuous time counterparts. The discrete time version of the generalized 
H 2 norm is: 

\\T,„h U := ^n^jjT„T;J{e»)dO), (3.24) 

where the function /(•) is again either the trace function, the maximum eigenvalue 
(Am aI ), or the maximum diagonal entry ( d maT ). The norm in discrete time can 

he defined as: 

IIT^IU := ^max <7, ma AT zw {e j6 )), (3.25) 

when* a maj ■ denotes the maximum singular value. 

Suppose the plant, Q , in Figure 3.2 is now represented by the following 
discrete time state-space model: 



Q : = 






ax 






y 



Ax + B\w + Bin 
CqX + Dq\W + D02U 
0 \X T D\\W -f- 
CiX + 



(3.26) 



where a denotes the shift operator (ax)(A') := x{k +1). Assume that (1) the triple 
(C* 2 , is stabilizable and detectable, and (2) given any complex number z satis- 
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fying |r| = 1 , the matrix 

■ A-zI B { 

. C 2 D21 _ ' 

has full row rank. The solution to the output feedback problem makes use of a 
suitably constructed optimization problem defined next. 

Suppose a feasible controller exists such t hat IIT^^Hoo < 1 . Then, it follows 
from [Ref. 31] that there exists a (unique) real symmetric matrix Q > 0 such that 
the matrices V and R defined by 



V 


:= C 2 QCj+D n Dl, 


(3.27) 


R 


:= I -D u D T u -C\QCj + 






(C,QCJ + D n Dl)V~ l (C\QCj + D n Dl ) T , 


(3.28) 



are positive definite. Moreover. Q satisfies the following discrete algebraic Riccati 
equation: 



Q = AQA T + B x Bj- 

c 2 qa t + d 2 X bJ iT 

CxQA’ + DnBj 



P(Q ) 



-1 



C 2 Q A T + D 2 \ Bj 
C,QA T +D U BJ 



where 



P(Q) ■■= 



D 2 1 Dj x 


D 2 iD]\ 


+ 


cy 


D\\ D\ x 


D\\Dj x - I 


.C,. 



ai 



id the matrix 



A - 



C 2 QA T + D 2l Bj 
C\QA T +D n Bj 



P(Q) 



-1 



Q{cJ cj 



c 2 

c\ 



(3.29) 



(3.30) 



is asymptotically stable. This is the discrete time analog of the continuous time 
filtering equation expressed by J( 7 ) in Theorem 3.1. With this matrix Q , define the 
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following matrices 

Z := AQCJ + B,D T U - (AQCj + B x Dj)V- x (C 2 QCj + D 2 ] Dj) 
A q :=A+ZR~ x Cx 

B hq := (AQCJ + B X DJ)V~'C + ZR~ x (C^QCj + D u Dj)V ~ 1 ' 2 

B 2<q -.= B 2 + ZR~' D u 

C 0 „ := Co 

An,, := (D 0 ,DJ + CoQCj)V-'C 
Do2,q •'= Dq 2 
C hq := R~ X ! 2 C\ 

Du* := R~ x, 2 (C\QCj + DuDDV-'C 
D l2 , q := R- x > 2 Du. 

Finally, define the following matrix functionals: 



L(W, Y, K2) 



M q (Q) 
M ( W, Y, K 2 ) 



A 

Cx 



B 2 
D 12 



Y 

W 



ir-i 



Y W T 



A T Cj 
Bl D* 



IS, + B 2 K 2 
Dn + D\ 2 I\ 2 

CqQCq + DqiDq^ — Doi, q ^ 01 , 



-+ 



"1 


, B\ + B 2 I\ 2 


T 


■ Y 


o ' 




D\\ + D\ 2 I\ 2 




0 


i 



M q (Q) + (C 0 Y + D 02 W)Y-\CoY + D 02 W) T + 
(An + Dq 2 I\ 2 )( An + Dq 2 I\ 2 ) t 



Let 4> define the set of feasible solutions: 

<f> := {{W, Y) : Y = Y t > 0, L(W, >\ I< 2 ) < o} , 
and consider the optimization problem 

o s := inf { /( M ( IV, Y, I\ 2 ) ) : (IF, F, I< 2 ) € 4>} . 



Theorem 3.5 The set of feasible controllers is not empty, if and only ij 
stabilizing solution Q > 0 exists that satisfies the conditions of (3.27-3.30), 
7 ^ 0. If a feasible controller exists, then 



J f (T Z0W (g ,C )) := f(M(W,Y,K 2 )). 



(3.31) 

(3.32) 

(3.33) 

(3.34) 

(3.35) 
(1) A 

and (2) 
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Moreover , given any a > (J j, there exists a solution , (\ V, Y, J \ 2 ) € ( I ) , and the dynamic 

observer-based controller (with input y and output u) 

{ ax c = A q x c + B\, q r c + B 2q u 

u = WY~ l x c + I\ 2 r c (3.36) 

r c = V~ ]/2 {y - C 2 x c ) 

such that C is feasible and Jj{G ,C ) = )\ 1\ 2 )) < a [Ref. 12]. 

To solve the output feedback generalized 'H 2 / control problem using 
Theorem 3.5, the following steps can be followed: 

1. Verify that a feasible controller exists; this can be done by solving two standard 
Riccati equations [Ref. 31]. 

2. Perform the convex optimization problem: minimize f(M(\\\}\ J\ 2 )). subject 
to the constraints Y > 0, and L{\\ \ ) \ I\ 2 ) < 0. 



3. Construct the output feedback controller C in (3.36) using the suboptimal so- 
lution (\Y\Y, I\ 2 ) obtained in step 2. Then, C is feasible and Jj(G\C) < a; i.e., 
(3.36) solves the generalized 7i 2 / control problem. 



As with the continuous time problem, where the problem was reduced for 
state-feedback, the measurement-feedback discrete time problem can be reduced for 
any problem where the states and disturbances are available for feedback. Consider 
the following full-information plant: 



G fi := < 



ax = Ax + B\W + B 2 u 
= C 0 x + D 0i w + D 02 v 






= C \x 

X 



y = 



w 



D 1 1 w T D\ 2 u 



(3.37) 



Though the full information structure is not realistic in applications, the solution to 
this problem gives a lower bound on achievable performance that might yield insight 
into more complex output feedback problems. 
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The above optimization problem can be reformulated for the full-information 
problem by omitting the solution of the Riccati filtering equation (3.27-3.30), omit- 
ting the formation of the auxiliary plant, and making the following replacements in the 
expressions for L and M: A q is replaced by A, I3j, q is replaced by Bj , C ltQ is replaced 
by Ci, and D thq replaced by Dij. The optimization functionals are modified by setting 
M q (Q) = 0. The resulting state-feedback controller is then C — K s jb = [WY~ l , A' 2 ]. 

The numerical routines which solve both the full-information and measure- 
ment feedback controller design problems are outlined in Appendix A. As with the 
continuous time problem, an ellipsoidal optimization routine was designed to solve 
the full-information problem. This function file could then either be used to solve a 
full-information problem directly, or be called by the measurement-feedback design 
code after the auxiliary plant had been posed. This problem could also have been 
solved by interior point methods, and the LMI expressions of the matrix functionals 
can be easily be determined by Schur complements. 

C. POLE PLACEMENT BY CONVEX METHODS 

Pole placement is possibly the most common metric used to specify the per- 
formance of closed-loop systems. The following outlines a convex constraint which 
can be used to determine state- feed back gains such that a closed-loop system has 
eigenvalues within a specified circle. 

Consider the region D defined by 

D := {z : \z + q\ <r, q>r > 0} . (3.38) 

It is a disk in the left half plane with center ( — </, 0) and radius r. Let a := q — r. 
Theorem 3.6 Given a state-feedback gain matrix K G R qxn , the eigenvalues of the 
feedback interconnection of Q and C = K lie within D if and only if there exists a 
symmetric matrix Y > 0 such that the following Quadratic Matrix Inequality (QMI) 
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is satisfied [Ref, 32]: 



S := {A + B 2 I\ + aI)Y + Y(A + B 2 K + aI) T + 

(A + B 2 I\ + o/)(l / /’)( A -f B 2 I\ + oI)T < 0. (3.39) 



By replacing K with WY \ this expression is equivalent to the following LMI 
by Schur complements: 



Si(W,Y) := 

“ ( (A + aI)Y + Y(A + aI) T + (A + aI)(Y/r)(A + a I) T + \ 
{ B 2 W(( A + al)/r + I) T + ((A + al)/r + l)\V T Bj ) 

(B 2 W) t 



b 2 w 

— Yr 



< 0 . 
(3.40) 



The set of state-feedback controllers with eigenvalues within D is therefore convex. As 
described in [Ref. 33], this constraint is perfectly suited for convex optimal control 
problems where the designer would like to restrict the search to those controllers 
whose eigenvalues lie in a specified region. 



D. ROBUSTNESS ANALYSIS BY STRUCTURED SINGULAR VAL- 
UES oo 

This section contains a description of the principal tools used to assess the 
robustness of feedback systems. In particular, we are interested in the use of the 
structured singular value. The structured singular value (/i) was first introduced by 
J. Doyle in [Ref. 34] and since lias proved to be a valuable tool for the robustness 
analysis of the closed-loop systems. In this section we briefly summarize the results 
of [Ref. 34, 35]. 

Consider the feedback system shown in Figure 3.3. Let F/(( 7 ) denote the 

feedback interconnection of the plant Q and the controller C and let T ZW (Q ,C ) denote 
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the corresponding closed loop transfer function from w to z . It can he shown that 




Figure 3.3: Standard feedback configuration with uncertainty block. 

any linear interconnection of plant, controller, and uncertainties can be arranged to 
match the nominal plant, Q , having the following form: 





Gn 

21 






' A 


By 


b 2 


Q = 


C7 12 

G'22 


— 


C, 

c 2 


Dyy 

D 21 


B 12 
D22 



where {C 2 , A, B 2 ) is stabilizable and detectable. For stability analysis, the controller 
can be absorbed into the nominal plant Q . The LFT ( linear fractional transforma- 
tion) representation of the feedback interconnection of the nominal plant G and the 
controller C is given by 

Fi(G ,C ) = Gn + G U C(I - G 22 C)' l G 2 

Recall that the problem does not explicitly address the issue of plant 

uncertainty. If, however, the plant uncertainty is modeled as an unknown but norm- 
bounded, stable dynamical system, with the inputs and outputs of the plant uncer- 
tainty block included in ^ and w respectively, then 'Hoo provides stability robustness 
guarantees as a result of the following theorem: 



Theorem 3.7 Small Gain Theorem [Ref. 36], A ssume Fi(Q ,C ) ts stable and A 
belongs to a set 

BA := {A : A G KHoo ,\\±\\<» < 1 / 7 }. 

Then the feedback interconnection of FfQX) and A is stable for all A 6 B A if and 
only if 

\\T zw (GX)\\oo<i- 

Unfortunately, Small Gain Theorem can be unnecessarily conservative when 
applied either to robustness analysis or design. This conservatism can be reduced 
by using the extension of Small Gain Theorem to structured uncertainties. The 
structured singular value is the metric by which this extension is applied. In order to 
define the structured singular value, let 

A = {diag( Ai,A 2 ,A„)}, 

where A,’s are stable FDLTI systems. Furthermore, let 

Ac = {<Ha.g( Ai,A 2 , A u )}, 

where each A, is a complex matrix. 

Definition 3.8 The structured singular valuf p(M(j^)) of the complex matrix Al(joj) 
is defined as follows: 

f o, //V A 6 Ac, Uet( / + M(ju)A) ± 0 
^ ' I sup j||A || -1 : A € A r ,det(/ + A) = 0, } otherwise. 

The importance of the structured singular value for studying robustness of feed- 
back systems is due to the following result [Ref. 34], which characterizes robust 
stability of a system in the presence of stable structured uncertainty. 

Theorem 3.9 Let 

BA = {A: A€ A,||A||oo< 1} 
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Then the closed loop system of Figure 3.3 is stable V A 6 BA if and only if 



p(F,(g,C) :=sup(/i(fi(0,C))(ju;)< 1 

Uf 



Applying this theorem as a test for robustness is much less conservative than 
the small gain theorem itself. By restricting the set of uncertainty matrices to those 
with the specified structure, a much larger set of LFT’s, F/(£/,C), satisfy the stability 
criteria. In other words, for structured uncertainties, there is a large set of stable 
systems that fail the criterion of the small gain theorem, and yet satisfy the latter. 
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IV. THE DESIGN OF AUTOLAND 
CONTROLLERS FOR CARRIER- BASED F-14 
AIRCRAFT BY AND Ho / H x METHODS 



A. INTRODUCTION 

This chapter presents the results of the application of Hoo and mixed 7^2 / H 0 o 
synthesis techniques to the design of autoland controllers for a carrier based F-14 
aircraft. These efforts had several objectives: 

• Demonstrate a methodology for H t50 output-feedback controller synthesis. 

• Expand that methodology for use with Hi / H^ synthesis tools, 

• Demonstrate the use of the Hi / H synthesis tools. 

• Demonstrate the feasibility of using Direct Lift in a multi-variable autoland 
controller. 

• Present a met hodology for the formulation of uncertainty models based on flight 
test data. 

The nature of the autoland controller problem and the unique configuration of the 
F-14, made this problem ideally suited to these objectives. 

Carrier approach and landing is a challenging multivariable control problem in 
which the aircraft states must all be carefully controlled in order to comply with 
multiple structural and safetv-of-flight constraints. Automatic landing systems cur- 
rently in service on carrier-based aircraft (including the F-14) incorporate nested 
single-input/ single-output (SISO) controllers, which generally seek to regulate the 
angle-of-attack with the engines in the inner loop, while aerodynamic surfaces such 
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as elevators or stabilators provide altitude control. Since neither the engines nor the 
stabilators can control the altitude state directly, their influence is indirect through 
a combination of other states. The F-14 has an unusual aerodynamic configuration 
which includes Direct Lift Control (DLC), thereby providing an aero surface with 
substantial authority to control altitude directly. Moreover, the DLC is driven by 
actuators whose bandwidth exceeds that of the other control surfaces. Regrettably, 
this powerful control surface is not used by the automatic landing system currently 
in service. In this chapter, two multivariable feedback controllers are presented which 
seeks to exploit this powerful, but dormant capability. 

To achieve this objective, the design methodology presented here was developed 
to enable the control engineer to translate the design requirements into weighting func- 
tions for Hoo synthesis. This methodology was then further extended for use using 
the 7^2 / 'Hqo design tools. Most typical design requirements are SISO in nature, 
whereas the 7 and 7 -f 2 / 7 synthesis techniques are truly multivariable tools. 
Thus, the main feature of this methodology is a simple procedure for translating 
the SISO requirements into the various weighting functions for and 7~0 / 'Hoo 

synthesis. Moreover, once the SISO requirements have been satisfied, the frame- 

work offers a natural way to expand the weighting functions to satisfy multivariable 
stability and performance robustness requirements. 

This methodology has been applied to the design of control systems for com- 
mercial airplanes, autonomous underwater vehicles (AUV’s), flexible structures and, 
most recently, for unmanned aerial vehicles (UAV’s), see [Ref. 6, 7, 8, 9, 10]. In 
[Ref. 6, 7, 8, 10] this technique was used to synthesize state-feedback controllers. In 
[Ref. 9], where a controller for a flexible structure was designed, the methodology 
was extended to include an output feedback case. The methodology outlined here 
expands this previous work to include compliance with closed-loop sensor bandwidth 
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requirements. 

Specifically, the methodology offers a simple and effective way to design feedback 
controllers satisfying specified: 

• command-loop bandwidths, 

• control-loop bandwidths, 

• closed-loop damping, 

• closed-loop sensor bandwidths. 

Each of the above objectives are pursued through a specific formulation of the synthe- 
sis model and selection of the various weighting functions. Furthermore, it has been 
observed that an additional benefit of this methodology is that the resulting con- 
trollers do not cancel the undesirable modes of the open-loop plant. This is attributed 
to the suitable choice of weights to satisfy the closed-loop damping requirement. 

The appeal of this methodology is that the control designer is provided with a 
straightforward framework in which to implement T^oo or ^2 / *Hoo controllers in 
pursuit of typical design requirements without a detailed understanding of the the- 
oretical basis for these tools. Moreover, the results of the design effort are assessed 
using familiar SISO figures-of-merit. The availability of good commercial software 
utilities, and ever-improving computational resources only enhance the viability of it- 
erative design methods such as the one presented here. This methodology is suggested 
as one means of placing these tools into the hands of practicing control designers. 

The controller design methodology we propose necessarily has a heuristic com- 
ponent. This heuristic component has been influenced by our experience in solving 
the practical problems mentioned above. Although we were successful in applying 
these design methodologies to this problem, we cannot offer any guarantees as to 



whether their application to an arbitrary control problem will yield a satisfactory 
solution. 

Additionally, a method is proposed for accommodating structured model un- 
certainty in flight dynamics problems. Specifically, in using models extracted from 
flight test data, the uncertainty in the total value of lift, drag and pitching moment 
may be less than the uncertainties in individual stability derivatives. For this type 
of data, a method is proposed that considers the total uncertainties in these forces 
and moments rather than the uncertainty introduced by each term of the model. 
The robustness of the resulting closed-loop nonlinear system is then analyzed using 
established structured singular value methods. 

This chapter is organized as follows. Section B contains the material relevant 
to both controller design problems. This includes a description of the the carrier 
landing problem and the design requirements. It also includes the details of the 
uncertainty modeling process which was used to analyze the robustness of the closed- 
loop systems. Section C presents the details of the / H 00 controller design process, 
the implementation of the controller on the nonlinear system, and the analysis of the 
resulting closed-loop nonlinear system. Section D presents the details of the mixed 
7^2 / Woo controller design process, as well as the analysis of the result ing closed-loop 
system. A comparison of the two design methods and some concluding remarks are 
then included in sections E and F. 

B. PROBLEM STATEMENT 

The objective of the controller design is to provide for precise automatic control 
of the approach and landing of a carrier-based aircraft in the vertical and longitudi- 
nal axes. In this section we describe both the plant to be controlled and the desired 
performance specifications. These specifications are classical in nature, and are rep- 
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resentative of those posed to control designers in industry. The notational convention 
adapted in this chapter was to use uppercase letters to denote total values of the vari- 
ables introduced, while lower case letters denoted the perturbations of these variables 
around their nominal trim values. 

1. Airplane and Model Description 

The design problem to be solved here deals with the longitudinal motion of 
a fighter airplane and the control of the longitudinal rigid body dynamics (by conven- 
tion, longitudinal flight mechanics refers to the motion in the 2-D plane spanned by 
the longitudinal and vertical axes). A complete description of an airplane’s equations 
of motion can be found in many available references. See, for example, [Ref. 37]. 
Consequently, we will not describe the equations of motion in detail. Rather, we will 
present a brief qualitative description of the key features. 

The longitudinal equations of motion of an airplane are described by two 
force equations (longitudinal force F r and vertical force F z ) and one angular moment 
equation (pitching moment M). The state variable associated with the F x equation 
is the forward velocity U (along airplane’s body-fixed T-direction ). The state variable 
associated with the F z equation is the angle of attack a (the angle between the body- 
fixed T-direction and the true total velocity). The state variable associated with the 
M equation is the pitch rate Q. The integral of Q for a typical approach and landing 
condition is the pitch attitude 0 (the angle between the body fixed .T-direction and the 
horizon). Other motion variables of interest are the airplane’s airspeed V t (generally 
not aligned with the body-fixed T-direction), flight path angle 7 (the angle between 
V t and the horizon), and airplane’s altitude above sea level IF All the angles used 
here are expressed in rad , angle rates in rad/ sec, position variables in ft , position 
rates in fps , and accelerations in g's. 



While the above discussion is germane to the (light dynamics of all aircraft, 
the F-14 has a distinctive aerodynamic configuration due to environment in which 
it was designed to operate. Mission requirements dictated a variable-sweep wing 
for low drag at high speeds, with full-span flaps and slats, for very high lift at low 
carrier take-off and landing speeds. Control along the longitudinal axis is provided by 
two afterburning turbofan engines (Thrust). Pitch control is provided by symmetric 
deflection of two stabilators (Stab). In the landing configuration (gear down, wings 
fully forward, and flaps fully extended), Direct Lift Control (DLC) is provided by 
symmetric deflection of wing mounted spoilers. The neutral position of the spoilers is 
approximately 40% of full deflection, so as to provide for both positive and negative 
contributions to the lift. 

For the design study, the sensors available included onboard accelerometers 
and gyros which provide pitch attitude (0), longitudinal acceleration (N x ), vertical 
acceleration (AL), and pitch rate ( Q ). Total velocity (V*), was provided by the air- 
craft's air data system. Lastly, for automated approaches and landings, the altitude 
(//) was determined by a shipboard tracking radar. 

The model used for the design process was a linear model obtained from 
a nonlinear simulation built using aerodynamic coefficient data. This simulation 
model was nonlinear in that while the aerodynamic derivatives were held constant, 
the equations of motion included the nonlinear influence of airspeed, gravity, as well as 
t he dynamic coupling terms. The flight condition was a nominal approach condition 
of 230 fps, at sea level, with a gross weight of 54,000 lbs. The linearized longitudinal 
model included five states: u, cv, q , 0 and h and three control inputs: Sstab , & Thrust 
and 8dlc, where all the linear states and inputs are small perturbations around the 
nominal operating point. At this condition, the longitudinal rigid body motion of 
the F-14 is characterized by two second-order stable modes, the phugoid and short 
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period, and an altitude integrator. The phugoid involves perturbations in V t and // 
with nearly constant a, whereas the short period mode involves perturbations in a 
and Q, with V t and // remaining constant. The short period mode had a natural 
frequency of 1.04 rad/ sec and a damping ratio of 0.45. The phugoid had a natural 
frequency of 0.18 rad/ sec and a damping ratio of 0.06. In addition to the plants five 
states, the actuators were modeled by three first-order transfer functions. These were 
appended to the control inputs and had bandwidths of 20, 2.5 and 50 rad/sec for 
the stabilators, engine, and DLC, respectively. As a result the complete system was 
represented by an eighth order linear model. 

2. Problem Description 

The general problem was to design a feedback controller which would satisfy 
the operational constraints imposed by the mission. The challenge of landing an 
aircraft at sea requires very precise control of the aircraft states. Glideslope, which 
is the desired spatial trajectory of the aircraft, must be tightly controlled to provide 
for safety and to achieve the precise touchdown necessary to be arrested on the ship. 
The glideslope is an imaginary ramp oriented three degrees above the horizon, moving 
with the ship and terminating in the center of the landing area. In the case of manual 
landings, deviations from glideslope are detected visually by the pilot with a visual 
reference to a shipboard optical system. For automated landings, a precision tracking 
radar onboard the ship compares the aircraft’s position with an internally calculated 
glideslope, and transmits an error signal to the aircraft’s flight control system via data 
link. Tight control of aircraft total velocity is driven by the competing requirements 
of providing for adequate aerodynamic performance, while minimizing the kinetic 
energy that the airframe and arresting gear must absorb upon landing. Tight control 
of the aircraft attitude is required to prevent tailstrike. Both of these objectives can 
be achieved by controlling angle of attack with total velocity and the pitch attitude 



as dependent variables, functions of the angle of attack. Angle of attack is also an 
attractive control variable as consistent aerodynamic performance is achieved for wide 
ranges of gross weights. 

The approach-to-landing problem can be fully characterized by several 
combinations of the variables in the state vector due to the mathematical and aero- 
dynamic relationships between these variables. Likewise the control objectives can 
be achieved by tracking any one of these combinations. Systems in fleet use today 
incorporate nested SISO controllers, with the engine controlling angle of attack in the 
inner-loop and the stabilators controlling either sink rate or flight path. The remain- 
ing variables are then dependent functions of t he gross weight and the two controlled 
parameters. In this design example, we propose to use DLC to provide independent 
altitude control of F-14 in approach and landing. Currently F-14's DLC is engaged 
for approach, such that the spoilers are deployed to their neutral DLC position. DLC 
is not utilized as part of the control system, however, and serves only to increase both 
the drag and the trimmed power setting (this is done in order to keep the engines in a 
more responsive range of operation). Neither the engines nor the stabilators provide 
control directly into the altitude state, but rather indirectly control the flight path/ 
altitude through the airspeed and pitch attitude states. Performance may thereby be 
sacrificed, as DLC is the only control effector which has control power directly into 
altitude through the vertical velocity, and DLC actuator is the fastest of the three 
available actuators. Given three independent control effectors with sufficient control 
power, F-14 has the resident capability to track three independent command signals. 
A multivariable approach to the control design would permit inclusion of the DLC 
in the control system resulting in both an enhanced capability and an improvement 
in performance. Therefore our control strategy was to track altitude (//), and angle 
of attack (a), using stabilators, engines and DLC. Since the number of controllers 
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exceeds the number of command variables, the flexibility existed to wash out one of 
the controllers. We chose to wash out the DLC. The desired effect was that the thrust 
would control the glideslope in steady state, while the DLC would provide dynamic 
glideslope control. Thus, the design problem was to synthesize feedback controllers 
which tracked a glideslope signal, while controlling angle of attack in steady-state, 
given the available sensor suite. 

3. Design Requirements 

In light of the above, the Tioo controller was required to satisfy the fol- 
lowing design requirements outlined below. These requirements will later be modified 
for the mixed 7^2 / Hoo design example 

1. Zero Steady State Error 



• Achieve zero steady state values for all error variables in response to step 
commands in angle of attack, and ramp commands in altitude (this was 
necessary for glideslope signal tracking and wind disturbance rejection), 
while washing out DLC in steady state. 

2. Bandwidth Requirements 

• The input-output command response bandwidth for all three command 
channels was to be approximately 1 rad/sec. 

• The control loop bandwidth was not to exceed 40 rad/sec for the DLC 1 
actuator, 20 rad/ sec for symmetric stabilator, and 2 rad/ sec for the engine. 
These numbers represented 80% of the corresponding actuator bandwidths 
to ensure that the actuators were not driven beyond their linear operating 
range. 
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• The sensor response bandwidths were to be approximately 100 rad/ sec for 
the gyros, accelerometers, and integrators, and approximately 5 rad/sec 
for the altitude, angle of attack and airspeed data. 

3. Closed-Loop Damping 

• The closeddoop eigenvalues associated with physical states were to have 
the damping ratio of at least 0.6. (This permits controller modes to have 
damping ratios less than 0.6). 

4. Robustness 

• The controller could not cancel the lightly damped open- loop poles of the 
plant 

• Simultaneous gain and phase margins of ±6 dB and 45 degrees in all control 
and sensor loops 

• Stability was to be guaranteed for simultaneous variations of 20% in the 
perturbed lift and drag forces and pitching moment. 

4. Uncertainty Modeling 

This section describes the methodology used for analyzing robustness of the 
closed-loop system consisting of the aircraft model and any controller. The aircraft 
model used in this chapter was obtained from the flight test data. As a result some 
of the terms in the model are poorly known. These terms include airplane’s lift, drag 
and pitching moment. On the other hand, terms such as gravity and aircraft dynamic 
coupling are known well. Furthermore, lift and drag are measured in the so-called 
stability axis, whereas the aircraft model was derived in the body-fixed coordinate 
system. These considerations indicate that the uncertainties in lift, drag and pitching 
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moment must be modeled exactly where they occur. Therefore, this should be done 
using aircraft’s nonlinear equations of motion while taking into account the coordinate 
systems where these forces and moments were measured during the flight test. A 
detailed discussion of this process is given next . 

Let x represent the vector of the longitudinal states of the aircraft: 

X = [(/, a, Q. 0, H] t . 

Let b represent the vector of the aerodynamic control effectors, consisting of the 
stabilators and DLC, and let F represent the vector of body-axis forces and moments: 

F grav {x) := influence of gravity 
Fdyn(x) •= influence of dynamic coupling 
Faeroix) := illfl uence of aerodynamic forces on the body 
F thrust influence of thrust 

F$ := influence of aerodynamic forces on the control surfaces. 



Note that the first three are state dependent, while the last two are functions of the 
appropriate controllers. The aircraft equations of motion can now be expressed as: 



V 

a 

Q 



— F gr av{ x ) + Fd yn (x) -f Fthrust + Rwbi x ) (F aero (x) + F(S)) 



(4.1) 



where R^x) is the wind to body axis rotation matrix: 



Rwb = 



— cos a sin a 0 

— sin a — cos a 0 

0 0 1 



(4-2) 



We only consider uncertainties in the aerodynamic forces and moments, 
since the gravity, dynamic coupling and thrust are all well known. 
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The aerodynamic model of the airplane is derived using stability deriva- 
tives, which represent the contribution of each state and control input to the aerody- 
namic forces and moments acting on the airplane. This data can be obtained either 
in the wind tunnel, where isolation of individual contributions is frequently possible, 
or flight test, where only macroscopic behavior is observed, and then numerically 
distributed among the aircraft’s states and inputs. The stability derivatives obtained 
from the flight test data therefore depend upon very complex multivariable parameter 
identification (PID) methods, which are executed in two steps. First, forces and mo- 
ments are computed from observed accelerations and rates. Second, the PID process 
tries to identify which control inputs and airplane states contribute to the observed 
change in forces and moments. This step clearly introduces errors not present in the 
first computation. 

Our choice is then to consider either the contribution of the uncertainty in 
each parameter, or the net uncertainty in our knowledge of the forces and moments. 
There are several reasons to choose the latter. First of all, the size of the uncertainty 
model is significantly reduced. Secondly, the uncertainties in each stability derivative 
are not independent. If they were, then large uncertainties in each stability derivative 
will result in large uncertainties in the net forces or moments, leading to an unnec- 
essarily conservative design. Consequently, we chose to model the uncertainty block, 
A, as a 3 x 3 diagonal matrix, where each diagonal element represented a percentage 
of the nominal perturbation in the aerodynamic forces and moments (drag, lift and 
pitching moment). Incorporating this block in equation 4.1 yields: 

' U ' 
a 

_ Q . 

Figure 4.1 depicts equation 4.3. Here signals ws and z$ denote the uncertainty inputs 
and outputs. 



— Fgrav ( x ) + ^dyn ( x ) + F thrust + Fwb( x ) ( / + A) ( F aero ( J* ) + F(8)) . (4.3) 
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Figure 4.1: Uncertainty Model 

C. Hoo CONTROLLER DESIGN 

In this section, we will describe the key features of the controller design process 
which we followed. The section is organized into a number of subsections that em- 
phasize some of the important engineering issues that arose in the controller design. 
The MATLAB scripts and SIMUL1NK models used to pose and analyze the problem 
are outlined in Appendix C. 

1. Synthesis Model 

The first step in the controller design process was the development of the 
synthesis model which served as an interface between the designer and the 
controller synthesis algorithm. 

Consider the feedback system in Figure 4.2. The synthesis model was 
derived from the linear model of the airplane by appending the depicted weights . 
The weights became the “knobs” which the designer adjusted to achieve his specified 
performance. Here C is the controller to be designed, P is the linear model of the 
F-14 and the block Q within the dotted line is the synthesis model. The signal iv\ 
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Figure 4.2: Synthesis Model 

represents the commanded inputs which were to be tracked: 

^*1 — hcmd V cmd @cmd 

The signal w 2 represented the noise inputs to each of the sensors, and disturbance 
inputs to the states of the plant. The signal u c represented the control inputs to the 
system and was composed of the stabilator command, the thrust command, and the 
DLC 1 command. The signals and x 2 are: 



x l 



= ( h a DLC ) x 2 = ( it a q 6 h ) . 



The signal c represented the vector of the tracking errors (e = Wi — a’i). 

The outputs of W\, W 2 and comprised the vector z. Since we required 
zero steady-state errors in tracking a ramp altitude command, and a step a and DLC 
commands, the weighting function W\ was chosen to have the following form: 
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where the constants C],c 2 and c 3 were adjusted to get the desired command response 
bandwidths. Thus, \\\ weighs the integrators on the regulated variable error channels. 
Furthermore, it was required to have full rank in order to satisfy the detectability 
assumption of Theorem 3.1. 

It turned out, that unlike W\, \V 2 and VF 3 did not need to include any 
dynamics. The choice for the weighting function \V 2 was: 
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where c 5 , and ce were adjusted to achieve the desired control loop bandwidths; 
W 2 was also required have full rank in order to satisfy the full rank assumption of 
Theorem 3.1. 

Next, the reader will note that the elements of the vector x 2 are the rate 
terms on the principal states of the plant. Selection of x 2 is an important element 
of our methodology. Applying the weight W 3 to x 2 , and including these signals in 
c, penalized activity in their corresponding states. The effect was similar to that, of 
creating rate feedback to augment damping, common to a classical controls approach. 
Importantly, H 3 did not need to have full rank. This permitted us to set multiple 
weights to zero and use non-zero values only in the event that a particular signal was 
necessary to improve damping. As a result H 3 had the following form: 

\V 3 = diag(e, ), 7-1 11, 

where c t ’s were used to improve damping in a particular mode, as will be discussed 
in the next section. 

The vector y included the system’s sensor outputs. Furthermore, y had 
to include the integral error state in order to satisfy the [C 2 , A, B 2 ) detectability 



assumption of Theorem 3 . 1 . Consequently, y was comprised of: 

V = 



he rv DLC 

h a v t 0 n z n r q — — 



One artificiality was introduced at this point: the presence of the integrated error 
terms in y necessitated the inclusion of noise signals on those measurements within 
the synthesis model in order to satisfy the rank condition on D2- Since the bandwidth 
of these “observations” were arbitrary, we set them to the highest frequency of the 
other observations. 

In summary, the cost function penalized a vector of the weighted integrated 
errors, the rates on principal plant dynamic states and the control inputs. The design 
process to be discussed is essentially a procedure for adjusting the weights on W\, W2 
and W3 in order to achieve the design specifications. 

2. The Design Procedure 

The design process is summarized next, followed by a detailed discussion 
of how each of the design steps were applied to the design example: 

1. Set all W 3 weights to zero. Use state-feedback design to determine weights for 
W\ and W 2 to satisfy the command and control-loop bandwidth requirements. 



2. If damping was unsatisfactory, refine the state-feedback design by adjusting 
IV3 weights to include lightly damped states in output z. These states were 
identified by examining the eigenvectors associated with lightly damped eigen- 
values of A + B2 1 \ s jb*i where I\ s jb was the state- feed back gain determined in 
step 1 above. The maximum element of that eigenvector corresponded to the 
state contributing most to the lightly damped mode. Increasing the weight in 
the corresponding IV3 entry had the effect of damping the dynamic activity of 
that state. Readjust W\ and W 2 weights to maintain the previously achieved 
bandwidth specifications. 



54 



3 . Given M 1,2,3 weights determined above, use measurement feedback design to 
determine the sensor noise weights in \] 4 necessary to satisfy sensor response 
bandwidths. 

1 . Determine the process noise weights in \V 4 by analysis of the broken-loop con- 
troller responses, adjusting the weights as necessary to match the cross-over 
frequencies that were observed for the state- feed back design. This step is simi- 
lar to Loop Transfer Recovery (LTR) technique developed for linear quadratic 
methods. 

5 . Readjust \\\ i2 ,3 as required to maintain previously achieved specifications. 

6 . Evaluate resultant controller using linear and nonlinear simulation. Adjust 
weights as necessary. 

7 . Confirm satisfaction of other specification elements: robustness, damping, and 
no cancellation of lightly damped open-loop poles. 

a. State-Feedback Design - Determining the W\ and W 2 Weights 

The objective of this step was the determination of the appropriate W x 
and W'2 weights to achieve the specified command and controller bandwidths. Visual 
inspection of bode plots for the broken-loop controller responses and the closed-loop 
command responses indicated which weight to adjust for the next design iteration. 
As a general rule, increasing the weight on the integral errors ( W \ ) increased the 
bandwidth of the respective command response channel, and increasing the weight 
on the controller commands (M 7 2 ) decreased the broken-loop cross-over frequency. 
This is identical to the behavior noted in H2 design, and is consistent with intuition, 
i.e., increasing the relative cost of the integral error should increase the closed-loop 
responsiveness of that channel in order to rebalance the costs. Similarly, increasing 
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the relative cost on a specified control signal should decrease the amount of energy 
applied to that control channel, and result in a decrease of that controller’s bandwidth. 
While adjustment of the weight on a given term consistently had the desired effect on 
the corresponding bandwidth, internal coupling meant that the influence of a given 
weight was not unidirectional and occasionally resulted in wild variations in the other 
Bode traces, invariably in the most undesirable direction. Occasionally, significant 
variations could also be attributed to the binary search stopping on a value much 
closer to the optimal than the tolerance. Considerable time could be expended chasing 
the various Bode traces, if an orderly methodology was not followed. Generally, once 
a desired cross-over or corner frequency was attained, weights were then adjusted in 
response to adverse coupling effects to restore that value to spec before any further 
adjustment of other bandwidths. Table 4.1 depicts both the nominal performance 
and the refined performance for several iterations as the weights were varied. Each 
entr\ ^presents the weight applied to the identified term in c in the numerator, and 
the resulting bandwidth in that channel in the denominator. The column for damping 
ratio represents the minimum damping ratio for all complex closed-loop poles. The 
frustration attendant with coupling across terms is evident from iteration two to 
three. Raising the second weight from the first to second iteration had successfully 
pushed the a response up to above one, but had an undesirable influence on the DLC 
response. 

b. Improving the State-Feedback Design: Rate Feedback for 

Damping 

By the third iteration, the bandwidths had been balanced close enough 
to the desired specifications to attempt improvement of closed-loop damping. The ob- 
jective here was to identify the principal states participating in under-damped modes, 
and increase the weight on their respective rates in the output z such that activity 
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TABLE 4.1: STATE-FEEDBACK DESIGN: WEIGHTS/RESULTING 
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in that mode was penalized. The intent was identical in philosophy to the purpose of 
rate feedback in classical control design. At the third iteration, the closed-loop sys- 
tem matrix (A -f B 2 K s jb) had two complex pairs of eigenvalues with damping ratios 
of 0.55 and 0.43. The two eigenvectors corresponding to these under-damped modes 
pointed in the directions of the hjs and q states respectively. This indicated that 
k/s and q were the dominant participants in each of the two under-damped modes. 
Since h/s was a state internal to the controller it was disregarded, and attention was 
focused on enhancing the damping on q . To improve the damping of these modes, 
the weighted output q was inc luded in z and the value of the corresponding term in 
U 2 was increased to a non-zero value. 

Initially a very small weight was introduced relative to the other 
weights. Each time a damping weight was adjusted, the and W 2 weights were 
readjusted in response, to regain the bandwidth characteristics previously achieved, 
prior to further refinement of the damping weights. The eigen analysis was performed 
prior to each adjustment of the damping weights to identify the most active state of 
each under-damped mode, and to insure that a different mode with different modal 
participation had not become under-damped. In fact, by penalizing participation of 
q in the under-damped mode, the mode shifted into the a and 0 states, requiring the 
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Figure 4.3: Broken Loop Controller Responses 

inclusion of a penalty against the respective rate terms. Rarely was more than one 
weight adjusted per design iteration, to preclude obscuring the influence of each ad- 
justment. A total of 24 iterations were required to achieve the design that approached 
both bandwidth and damping specifications. From Table 4.1, the weighting functions 
14V W 2 and at the conclusion of this phase had the following values: 
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Figures 4.3 and 4.4 depict the broken-loop controller responses, and the closed-loop 
command responses for this selection of weights. 

c. Output Feedback Controller Design - Selecting the Measure- 
ment Noise Weights 

The next step was to determine the weights to be applied to the 
measurement noise signals, which mathematically show up only in the D 2 matrix 
of the synthesis model. Initially, the weights on the regulated output 2 determined 
by the state-feedback design process were used in the output feedback design. The 
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Figure 4 . 4 : Closed-Loop Command Responses 



objective of this phase was to tune the controller such that the influence of each sensor 
channel on the controller did not exceed the expected reliability of the sensor. For 
example, if a sensor could be regarded as reliable at frequencies up to 10 rad/ s, then 
the controller response to that sensor channel should roll off at a frequency less than 
or equal to 10 rad/s. Consider the following representation of the controller: 



C = 



C — + B c y 

u = C c ( 



(4.4) 



The frequency responses of the diagonal terms of the transfer function matrix 
( \{sl — A c )~ x B c were plotted to evaluate the influence of each channel on the con- 
troller (Figure 4.5). The outputs of this transfer matrix represent the estimates of the 
states of Q in the presence of the worst case disturbance [Ref. 18]. By examination 
of the corner frequency for each of the ten channels of C 2 (.s/ — A c )~ x B c , the weights 
could be adjusted to achieve the desired sensor response bandwidth. Increasing the 
weight on a given term resulted in the bandwidth for that channel being decreased. 
This is similar to the results encountered in 7 ~f 2 design and is consistent with intu- 
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Figure 4.5: Sensor Responses 

ition. Very little effort was required to find the appropriate set of weights since little 
coupling was observed between the sensor channels. The accelerometer bandwidths 
could not be exceed 10 rad./ sec because of the internal dynamics of the controller. 

d. Output Feedback Controller Design - Selecting the Process 
Noise Weights 

The next step of the design process was the determination of the 
process noise weights. This phase was similar in execution to the “loop recovery” 
process of LTR, with a slightly different purpose. While the objective with LQG/LTR 
is principally the recovery of state-feedback robustness properties, the objective here 
was the recovery of the performance characteristics of the state-feedback controller, 
as reflected by the various bandwidth and damping specifications. Unlike each of the 
previous steps, in which a specific weight could be expected to control a particular 
trace on the graphs, this was not so for this phase. Additionally, there was coupling 
into the closed-loop sensor responses as the state process noise weights were changed, 
which required some additional adjustment of the sensor noise weights to maintain 
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the desired sensor response bandwidths. The final value of \V 4 was: 

W 4 = 0.00001 *diag(0.1, 4, 4, 0.01, .01, .01, 0.1, 10, 10, 1, 5, 5, 5) 

e. Linear Simulation- Assessing the Controller Structure 

At this point the closed-loop linear system was simulated in order to 
determine whether reasonable actuator deflections were being used, and to ensure 
that an altitude ramp could be tracked while controlling a to a desired trim value 
and DLC to zero. The closed-loop system was initialized to level flight and then 
expected to intercept and track an altitude ramp. While the altitude ramp was suc- 
cessfully intercepted and tracked, both o and DLC stabilized at values other than 
their respective set points. Examination of the transfer functions from altitude com- 
mand to a and DLC revealed only a single zero at the origin within each numerator. 
In both cases there was an additional zero numerically close to zero, but insufficient 
to provide the desired washout characteristics. To achieve these characteristics, an 
additional integrator was added to both channels in W\. A new controller was then 
obtained using this modified synthesis model with the same scalar weights determined 
above. This controller was then evaluated using the identical simulation, with the 
result that both o and DLC stabilized at their desired values. Finally, slight change 
in W\ and W 2 resulted in the final determination of the bandwidths. The final values 
of the weighting matrices were: 





1U 

s 2 


o 

o 




5 


0 


0 \ 






0 


7 0 


, w 2 = 


0 


0.1 


0 


, vr 3 = diag(0, 10,5, 1,0) 




0 


0 i J 




o 


0 


1 ) 





Figures 4.6 and 4.7 depict the resulting broken-loop controller responses and the 
closed-loop command responses. The Nyquist plots of the broken loop responses for 
each control input are shown in Figure 4.S. 
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Figure 4.6: Output Feedback Broken-Loop Controller Responses 




Figure 4.7: Output Feedback Closed-Loop Command Responses 
3. Specification Compliance 

Figures 4.6 and 4.7 show all the control and command loop bandwidths 
as satisfying their respective specifications, with the exception of the a command 
response which is slightly low at approximately 0.8 rad/ sec. The notch is due to the 



62 



5 



4 - 




E 



*1 - • - 
*2 - 

*3 - - 

-4 - 

*5 1 

-5 0 5 

Real 

Figure 4.8: Output Feedback Broken-Loop Nyquist Plot 

presence of a zero in the a command loop. No objectionable properties result since 
that channel is used to regulate a constant command rather than respond to changes in 
the command signal. The Nyquist plot in Figure 4.8 clearly depicts the simultaneous 
phase and gain margins requirements as being satisfied, with all three controller traces 
staying in the right half plane for all frequencies. Eigen decomposition of the closed- 
loop system revealed a complex pair of eigenvalues which failed the damping ratio 
requirement (0.45). Examination of the corresponding eigenvectors, however, revealed 
that no vehicle states and only controller states were participating in this mode. 

The next step was to ensure that the cancellation of the plant’s lightly 
damped modes by the controller had not occurred. The controller is a 3 x 9 matrix 
of transfer functions, and while cancellation may occur in one or several channels, 
complete cancellation would only occur if all the channels had a common numerator 
term. See [Ref. 38] for a discussion of multivariable transmission zeros. Figure 4.9 
depicts the singular values of the open-loop control responses. The presence of a clear 
spike at the frequency of the lightly damped phugoid mode and a small bump at the 



63 




Figure 4.9: Control Loop Gain Singular Values 

frequency of moderately damped short period mode indicates that the controller has 
not canceled these open-loop poles. Numerical analysis revealed no transmission zeros 
in the controller, further confirming the absence of pole-zero cancellations. 

4. /.i Analysis 

The robustness analysis was performed by determining the structured sin- 
gular value of a linearization of the closed-loop uncertainty model consisting of the 
nonlinear plant and the Tioo controller, as discussed previously in section B.4. This 
linearization was performed about the trimmed operating condition, with the uncer- 
tainty inputs and outputs ivs and z& included in the nonlinear equations of motion 
as shown in Figure 4.1. Figure 4.10 depicts the resulting structured singular value, 
where the peak value of 0.6 indicates compliance with the condition of Theorem 3.8 
and the robustness design specification. 

Note, had the design effort failed to yield the desired robustness, the design 
process could have been repeated with the signals w$ and zs incorporated in the 
synthesis model, and using either Hoo synthesis or D-K iteration [Ref. 35]. 
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Figure 4.10: Structured Singular Value Plot 
5. Nonlinear Simulation 

In this section we present the results of the nonlinear simulation of the 
Hoo controller. First, the controller was implemented on the nonlinear plant using 
^-implementation methodology (see [Ref. 39]). The methodology is based on the 
observation that linear controllers are designed to act on the perturbations about 
the plant’s nominal trajectory. Next, as with the linear simulation performed in 
section C.2.e, the controller task was to intercept and track an altitude ramp, while 
appropriately controlling the other signals of interest. A vertical and horizontal gust 
held of moderate intensity (rms= 10 fps) was included in the simulation. Results 
are depicted in Figure 4.11, where all the variables are shown as deviations from the 
trimmed level flight condition. The simulation was initialized in steady level flight 
with all surfaces at their trim positions. In response to the altitude ramp, the DLC 
and stabilizer deflected immediately to establish the appropriate descent rate. The 
result is a decrease in both a and 0. The altitude overshoots the ramp, and then 
corrects to the proper trajectory. Both the average angle of attack and the average 
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Figure 4.11: Nonlinear Simulation Results 



DLC wash-out to their desired trim values as the altitude error is nulled and the thrust 
decreases to stabilize at the new steady-state condition. Deflections and deviations 
are all well within reasonable practical values. This simulation validated the results 
of the design effort. 

6. Hoo Design Conclusion 

A measurement feedback controller was successfully designed to provide 
longitudinal control of an F-14 aircraft during automatic landing, and implemented 
on a nonlinear simulation. A key feature in the design was the exploitation of the 
aircraft’s Direct Lift Control to provide for enhanced landing performance. Addi- 
tionally, a methodology was detailed whereby SIS0 performance requirements were 
achieved using synthesis. Finally the resulting controller was validated on the 

nonlinear simulation. 
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D. MIXED W 2 / Woo CONTROLLER DESIGN 



The purpose of this section is to present the design example demonstrating both 
an application of the W 2 / Woo design tools, and a methodology for their use. The 
previous problem was actually born out of a desire to fully develop the methodology 
for the pure Wco problem prior to its application to a more complicated mixed 
problem. Both the synthesis and analysis models used the identical MATLAB scripts 
and SIMULINK models as the above problem. The design tools for this problem were 
created by the author and are developed and outlined in Appendix A. 

1. Problem Description and Design Requirements 

The problem description and design requirements for this example were 
identical to those outlined in section B above, with slight modification. In order to 
demonstrate the attributes of the mixed design tools, a more severe robustness re- 
quirement was included. Specifically, stability was to be guaranteed for simultaneous 
variations of 40% in the perturbed lift and drag forces and pitching moment. In the 
previous example, the robustness of the closed-loop system was assessed after the 
design process. In this design example, it was decided to explicitly impose the ro- 
bustness requirement in the design process using the Wco feature of the design tools, 
lo accommodate the increased robustness specification, it was decided to relax the 
desired performance requirement slightly. Rather than the command performance 
bandwidths of approximately one rad/sec which had previously been required, the 
desired command bandwidths were set at approximately 0.5 rad/sec. 

2. Synthesis Model 

The Woo design tools used in the first design example found the con- 
troller, C , that minimized \\T ZU \Q , C )||co* The mixed W 2 / Woo tools find the con- 
troller that minimizes the mixed cost: \\T ZoW (Q ,C )|| 2 /oo<> subject to the constraint 
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|| T ZjW (G ,C )||oo < 7. Consequently, the synthesis model complexity was increased in 
order to accommodate the signal Zo, which was not present in the previous example. 
From Chapter III, the mixed 7i 2 / 7"Co problem required that the synthesis model 
be posed in the form: 

x = Ax + B\w + B 2 u 

q £0 = C 0 x + Do\W + Do 2 u 

z 1 = C\x + D\\w + D\ 2 u 

, y = C 2 x + D 2i w + D 22 u 



In order to pose the problem in this form, consider Figure 4.12. This figure 
depicts the synthesis model where the signals were chosen to comprise each input 
and output vector. The choice of signals to include in iv, Zo and z\, as well as the 
various weighting functions, were determined both by mathematical necessity, and 
the objectives posed by the problem description. 




Figure 4.12: Mixed H. 2 / Synthesis Model 

The vector Z\ consisted of the signals whose output energy would be limited 
by the 7ioo constraint. Since the Tfoo constraint was to be used to explicitly 
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achieve the specified robustness, the uncertainty input ws was included in w, and 
the output of the uncertainty model 2$, was included in Z\. The uncertainty model 
depicted in Figure 4.1 was used to find a linearization of the open-loop system with 
the input vector ws, and output vector, Z&. As the consequence of constraining 
II T ZIW (Q X ) 1 1 oo < 7> \\Tz 6 w 6 (G X )||oo < 7 would be guaranteed. The requirement 
have full column rank necessitated the inclusion of the output of any 
pure integrators, and the requirement that Du have full column rank necessitated 
the inclusion of the control inputs u c in z } as well. In order to restrict the amount of 
conservatism that these two signals added to the 7 constraint by their presence 
in z i, small attenuating values were chosen for the weighting functions Ws l and W$ 2 . 
After several iterations of the design process it was evident that double integrators 
would again be required on each of the regulated error channels. Consequently, the 
final weighting matrices on z \ had the form: 

in- 3 

W 6x = —5-/3 W b3 = diag( 10~ 3 , 10- 6 . 10- 3 ) 

The second element of W$ 2 was specifically smaller than the others because it multi- 
plied the thrust channel, whose units ( Ibf ) resulted in high signal amplitudes. The 
weighting function \\\ was set to 0 . 4 / in order to scale the uncertainty model such 
that \\T 26W6 {Q X )||oo < \\T ZlW {G X )|U <7=1 would satisfy the robustness spec- 
ification of 40 % gross parametric variation. Each of these weighting functions were 
constants and not adjusted during the design procedure. 

The vector Zq represented those signals which would appear in the quadratic 
cost function. As with the previous pure 7 Yoo problem, the weighting functions 
W 1 , Vi 2, W3, and W 4 consequently represented the degrees of design freedom, while 
constrained by the above specification. In order to achieve similar results as 

the previous example, Zq was selected to be identical to the previous 2, as was the 
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structure of the weighting matrices. To be able to adjust the command bandwidths, 
the integrated errors were again included in the output signal, resulting in the first 
weighting matrix having form: 



IV, 



% ° ° 

0^0 

s / 



0 0 % ) 

As in the previous problem, \V 2 , W 3 , and W 4 were diagonal matrices of constants. 

3. The Design Procedure 

The design process was virtually identical to that outlined in section 2. 
above. The only exceptions were in the formulation of the synthesis model, as de- 
scribed above, and in the use of the mixed 7i 2 / Hoo design functions outlined in 
Appendix A, in lieu of the commercial design tools. Due to lack of time, the 

design example was terminated with the design of a state-feedback controller, how- 
ever, Appendix A does include both the state-feedback and measurement feedback 
design routines. 

Since the procedure otherwise followed the procedure of the first example 
exactly, the details are omitted. The mixed 7^2 / 'Hoo design tools did permit the 
selection of which generalized mixed costs was to be used (trace, maximum eigenvalue 
or maximum diagonal element). Several iterations were done using both the trace and 
the maximum eigenvalue. It was observed that the trace was more appropriate to this 
particular methodology, in that it was easier to influence all of the various bandwidths 
by adjustments of the weighting matrices. Several bandwidths were comparatively 
insensitive to adjustments of the weights when using the maximum eigenvalue as the 
cost functional. This is consistent with intuition when one considers the geometric 
implications of choosing the trace relative to the maximum eigenvalue. Table 4.2 
summarizes the progress of the design effort using the trace. Each design iteration 
required approximately 30 minutes of cpu time on a SparclO workstation. Step 9 
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TABLE 4.2: STATE-FEEDBACK DESIGN: WEIGHTS/RESULTING 

BANDWIDTHS 
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marked the point when the additional integrators were added to the weighting matrix 
W\. This altered several bandwidths slightly, though the scalar weights themselves 
were not adjusted between steps eight and nine. 

The above design resulted in two pairs of lightly damped eigenvalues, with 
damping ratios between 0.2 and 0.4. Modal analysis revealed that only the thrust 
was significantly participating in these modes, with no participation by the aerody- 
namic states. This was regarded as acceptable, and no further damping improvement 
was attempted. The weighting matrix Wj, was consequently all zeros. Since the 
measurement-feedback controller was not pursued, the weighting matrix W 4 was left 
as all zeros as well. 

4. Specification Compliance 

Figures 4.13 and 4.14 depict the broken-loop controller responses, and the 
closed-loop command responses. Each of the broken-loop controller responses is less 
than the specification, indicating that the actuators would not be driven at frequen- 
cies greater than their bandwidths. The closed-loop command responses of 0.4 for 
the altitude and DLC channels were slightly less than the specification value of 0.5 
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Figure 4*13: Broken-Loop Controller Responses 

rad/ sec. Figure 4.15 depicts the Nyquist plot for the broken-loop controller responses. 
The Nyquist plot shows the controller loops as satisfying the simultaneous phase and 
gain margins, with the exception of the DLC loop which slightly violated the out- 
side corners. It is interesting that the DLC loop stays outside the unit circle around 
( — 1 . 0 ) , as would be expected when using Loop Transfer Recovery Methods with a 
pure 7i2 controller design tool. 

Figure 4.16 depicts the singular values of the open-loop controller response. 
The clear peak corresponding to the short-period frequency indicates that this mode 
was not canceled by the controller. 

5. /^-Analysis 

Figure 4.17 depicts the structured singular values for the closed-loop system 
Tzfi-wtiG >C ). The peak fi value less than one confirms the robust stability of the 
system to uncertainties greater than the specified 40%. That the peak value is well less 
than one highlights the conservative nature of using Tira constraints for robustness 
when the uncertainty can be expressed in a structured fashion. 
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Figure 4.14: Closed-Loop Command Responses 




Figure 4.15: Broken-Loop Nyquist Response 
6. Linear Simulation 

A linear simulation was performed in order to ensure that the resulting 
closed-loop system fulfilled the design requirements. Figure 4.18 depicts the response 
of the system to a ramp altitude command. All variables are depicted as perturbations 
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Figure 4.16: Open-Loop Singular Values 




Figure 4.17: Closed-Loop Structured Singular Values 

from their trimmed condition. 

Since the command bandwidths are slower than those for the first design 
example, the response of the regulated signals to the altitude ramp is predictably 
slower. The desired wash-out characteristics are displayed, though, on altitude error, 
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Figure 4.18: Linear Simulation Results 



angle-of-attack, and DLC deflection. 

7. Mixed >f 2 / 'Hoo Controller Design Conclusions 

The methodology of section C. vvas successfully extended for use in the 
design of mixed 7i 2 / 'Hoo state-feedback controllers. Furthermore, a synthesis model 
formulation was demonstrated whereby the >f 2 / 7-Co design tools could be applied in 
order to achieve explicit robustness guarantees, simultaneous with other classical SIS0 
design requirements. The final controller design was validated by linear simulation. 



E. CONTRASTING THE AND H 2 / DESIGN TOOLS 

Because of the similar synthesis models and design methodologies, the effort 
required to implement the two tools was virtually identical. In fact, a single MAT- 
LAB m-file was used to prepare the two synthesis models, with only slight variations 
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required. A positive attribute of the H 2 / Hoo tools was that little procedural ef- 
fort was required to shift to the 7Y 2 / Hoo tools from the Hoo tools. The mixed 
7~f 2 / 'Hqo design tools did demonstrate one significant disadvantage over the pure 
'Hoo method. While the computation of a single Hoo controller would require less 
than 30 seconds, the computation of an 7^ 2 / Hoo controller for this 14 state problem 
required between 12 and 45 minutes, depending on the scalar weights chosen. This 
was partially attributable to the particular implementation of the convex optimization 
methods. The computational time could be probably be dramatically reduced with 
a FORTRAN or C implementation of the interior point method, rather than the el- 
lisoidal codes used here. However, even the most efficient optimization routine will be 
dramatically slower than the nearly direct computational means available by Riccati 
methods. Consequently, the mixed H 2 / H 00 tools should only be used in situations 
where the H 2 norm is an explicit expression of some specific design specification .j 

F. CONCLUSION 

This chapter demonstrated the application of Hoo and mixed H 2 / H 00 con- 
troller design tools to the problem of autoland controller design. A methodology 
was presented whereby classical SISO design specifications could be translated into 
scalar weighting functions appended to the synthesis model for either controller design 
scheme. Furthermore, a methodology was presented for the modeling of uncertainties 
in flight dynamics problems, and was then applied in the analysis of the robustness 
of the resulting closed-loop systems. 
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V. INTEGRATED AIRCRAFT/CONTROLLER 
DESIGN BY LINEAR MATRIX 
INEQUALITIES 



This chapter presents a methodology by which aerodynamic surface sizes can be 
optimized using performance requirements which are posed as Linear Matrix Inequal- 
ities. Several examples are presented which demonstrate the utility and flexibility of 
the method. The MATLAB files which support the material of this chapter can be 
found in Appendix D. 

A. INTRODUCTION AND PROBLEM MOTIVATION 

The control design process for rigid body vehicles (air, marine and space) in- 
cludes not only the design of the control system itself, but also the refinement of the 
size of the control effectors. Generally, the shape and overall size of the vehicle is 
dictated by mission constraints such as payload, range, or maximum speed. Control 
effectors and stabilizing surfaces are then appended to the baseline vehicle to pro- 
vide sufficient control power so that, in concert with an appropriate control design, 
the desired dynamic performance is realized. Control power is very expensive, 
resulting in increased weight, drag, signature, and financial cost. Consequently, the 
configuration designer would like to incorporate only that amount of control power 
that is necessary to attain the desired dynamic performance requirements. The ad- 
vance of controls technology in the past 25 years have led many commercial and 
military aircraft designers to consider reduced static stability aircraft as a means of 
improving performance and lowering cost. 



The question spawned by this drive toward improved performance is consequently 
how much control is enough? There are actually two facets to the question. First 
of all, flying qualities specifications must be identified, which, if satisfied will permit 
the vehicle to meet its mission requirements. Much of this field relies on the subjec- 
tive opinions of pools of research pilots and engineers. Flying qualities consequently 
translates mission requirements into dynamic performance requirements. Consider- 
able work has been invested by the military services and NASA in recent years to 
expand the traditional flying qualities standards [Ref. 1] to the new paradigm of 
relaxed static stability aircraft. The second facet of the problem is translating the 
flying qualities specifications into physical configurations and control systems. This 
question is addressed by this work. 

In aeronautical applications, control sizing is driven by several distinct environ- 
ments. Each of these must be independently considered in the design, and the most 
stringent adopted. The three principal environments are: 

• Take-off, Approach and Landing (terminal area flight); 

• High angle of attack flight; 

• Supersonic flight. 

Corresponding to each of these environments is a set of critical center-of-gravity (eg) 
locations. For each of these eg locations, sufficient control power must exist to provide 
the controls designer with the capacity to achieve appropriate dynamic performance 
(stability, maneuverability, and disturbance rejection) for both nominal and failure 
conditions. However, the nature of the control power required to provide such per- 
formance differs greatly from environment to environment. For example, in the case 
of supersonic flight, the principal issue is maneuverability. Here, control power can 
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be degraded by changes in the aircraft center of pressure or blanking of the control 
surfaces by shock-waves. Experience with supersonic flight has provided a base of 
knowledge for providing adequate control power in this environment. Since control 
power is basically proportional to the airspeed squared, it is more frequently crit- 
ical at the other extreme of the operating envelope, at slow speed, such as during 
high-angle-of-attack maneuvering and take-off/approach/landing. In the case of high 
angle-of-attack flight, the aerodynamics are very non-linear, and the concern is the 
ability to generate specific rates or accelerations (maneuverability). The specifications 
are therefore generally expressed as open-loop rates or accelerations. 

The specifications determining the control power requirements for slow speed 
terminal-area flight are both closed-loop and open-loop. In this environment, the 
concern of the configuration designer is to provide the controls designer with adequate 
control power such that a controller can be designed which satisfies the specified 
closed-loop flying qualities, as well as open-loop maneuverability. Unlike the other 
two environments, linear flight mechanics prevail, and the vehicle can reasonably be 
modeled as a linear system. A significant portion of the control sizing problem is 
consequently a linear controls problem. 

This chapter addresses the problem of simultaneous aircraft/controller opti- 
mization. As discussed in Chapter III, many closed-loop control problems and flying 
qualities specifications can be formulated as convex optimization problems, some of 
which can further be simplified into LMI’s. It has been our observation that for many 
rigid body systems, performance specifications which are posed as LMIs provide a 
means for not only solving the controller design problem, but also directly determin- 
ing the upper-bound for the minimum necessary control power. As a result of the 
this work, the aircraft and control system designers will be provided with a new tool 
capable of answering the plant/controller optimization problem : 
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Given the flying qualities requirements for a specified mission, find the 
minimum aerodynamic surface sizes, and a feedback controller, which to- 
gether satisfy mission requirements. 

The answers obtained are important to reduce aircraft weight, size, and ob- 
servability and would result in cost savings in many current and future aircraft pro- 
curement programs. The application of these methods is certainly not restricted to 
aeronautical applications, in that control power is expensive in all engineering sys- 
tems. In a chemical process system, the control power is reflected in the diameters of 
the pipes and tubing. The controls designer here is no less interested in minimizing 
the costs of achieving adequate control power. 

For aeronautical applications, the seminal work to date on this subject was a 
design guide published by the Grumman Corporation in support of NASA’s X-29 
program [Ref. 5]. The scope of that effort was significant, including non-linear aero- 
dynamics and flexible structures, issues which were beyond the scope of the material 
treated by this research. The authors acknowledged, however, that a limitation to 
their approach was the a prior'i choice of the structure of the controller. They sug- 
gested that optimization tools would be required in order to relax this constraint. The 
problem considered in [Ref. 5] is consequently a search over the set of plant config- 
urations that, in concert with the specified controller, yield the desired performance 
requirements. Recently developed computational tools (such as those presented in 
Chapter II) and the convex formulation of many powerful control problems now per- 
mit the consideration of the larger problem, where the designer is not restricted to a 
specified controller structure, but can instead examine the set of all controllers which 
satisfy the performance measures. 
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The sections that follow present a formulation and methodology for the opti- 
mization of an airframe using LMFs to pose the design constraints. First, section 
B will define the problem. Then, in section C, a pure Hoo constraint will be used 
to pose disturbance rejection requirments. A formulation will then be presented for 
the solution of the plant/controller optimization problem, and demonstrated by an 
example. The example problem will be a regulation problem in which there is no 
command tracking signal, but instead a controller which simply stabilizes the system 
and provides a specified disturbance attenuation. This section will also present how 
this formulation can be expanded to include diverse specifications at multiple 

flight conditions. Next, in section D, both internal stability and disturbance rejection 
specifications will be considered. Section E will present several methodologies for 
formulating the various open-loop maneuverability requirements as LMFs. The ex- 
amples in this section will demonstrate the application of open-loop maneuverability 
requirements. Next, section F presents a formulation for accommodating paramet- 
ric uncertainty in plant optimization process. In wrapping up, section G discusses 
the results, their limitations, and other applications, while section H discusses future 
directions for this research. 

B. PROBLEM DESCRIPTION 

Once again, the problem we sought to address in this research can be stated as 
follows: 

Given the flying qualities requirements for a specified mission, find the 
minimum aerodynamic surface sizes, and a feedback controller, which to- 
gether satisfy mission requirements. 

It will be shown that determining an upper-bound to the optimum answer to this 
problem can be reduced to minimizing a linear cost (a function of aircraft parameters) 
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subject to matrix inequalities which represent the mission performance requirements. 
The problem formulation and proposed solutions are discussed next. 

Let ( be a vector of the aircraft parameters which we would like to optimize. 
Furthermore, suppose the plant matrices A, B\ and B 2 can be expressed as affine 
functions of the plant parameters. In other words, let 

A = A(C) = Ao + ±GA" 

i = l 

B, = B(()=B,„+EC,B,„ 

1=1 

r 

B2 = B(o — B 2n + y; Ct b 2 , . 

t=\ 

Later examples will demonstrate that many plant parameters, such as the area of an 
aerodynamic control surface, naturally occur as affine variables in a dynamic systems. 
Since ( represents physical sizes for the proposed problem, we constrain Q > 0. Let 
J = c T ( be the cost function, where c* > 0 denotes the relative cost we choose to 
assign to each parameter Q. For example if we seek to minimize the total mass of the 
physical control surfaces, and (i were the physical area of each control surface, then 
Ci might be the mass per unit area, and J the total weight of the subject components. 
Or C{ could be selected to be the cost per unit area, in which case J is the total cost of 
adding surfaces under consideration. The linear cost functional J(Q is clearly convex 
in (. While a linear combination of the optimization parameters is the easiest to 
accommodate, the general formulation proposed would permit any convex function 
of the optimization parameters. The general problem can now be stated as: 

Minimize: J = c r (, 

Subject to: F(£,£) < 0, (5.1) 

where F(£,£) < 0 reflects all the relevant performance requirements. It was our desire 
to determine if these performance constraints could be posed in some manner that 
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would permit solution of the optimization problem by convex methods. In order to 
do this, we considered the various types of constraints which typically arise in flight 
mechanics. 

The three general sets of performance criteria which drive control power re- 
quirements are stabilization, disturbance rejection, and maneuverability [Ref. 5]. 
Stabilization requirements pertain to the internal dynamics of the problem and are 
frequently posed as pole-placement requirements. Much of the concern relevant to 
control power optimization can be attributed to the trend towards vehicles with un- 
stable open-loop modes, and the acknowledgment that some portion of the control 
power would have to be devoted to providing closed-loop stability. Simple stabil- 
ity can be posed as either a Lyapunov inequality, or an H , oo constraint. Chapter 
III described how a pole-placement requirement could be posed as convex matrix 
inequalities. 

The second type of requirement which influences the necessary control power 
is disturbance rejection requirements. These are usually posed as limitations on the 
rms output, as a consequence of a specified rms input. The disturbance attenua- 
tion specifications can be directly posed as 'H OQ constraints, which we know to be 
expressible as a matrix inequality. The inputs are generally meteorological gusts, 
represented by a model such as the Dryden turbulence model [Ref. 1]. The outputs 
include both the physical response of the states and the closed-loop response of the 
actuators. The specification determines the first, while physical constraints, such as 
the actuator deflection limits and limit rates, define the limit acceptable values for 
the latter. The 7i c c constraint is well suited to these types of performance measures 
due to its power gain interpretation, as described in Chapter III. An constraint 

will not ensure that a peak actuator deflection can not exceed a given value, but it 
can limit the power signal of the actuators deflection and rate. 
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Maneuverability is the third performance measure which drives control power. 
The constraints here have the form that a specified output should exceed a given 
value when all relevant controllers are fully deflected in the appropriate direction. 
This is an “open-loop” requirement to a flying qualities engineer because the loop in 
which he is interested is open — the pilot's command is saturated and the pilot is not 
trying to actively track some variable. This need not imply that the loops within the 
controller are “open”, and a controls engineer may use either an open or closed-loop 
formulation. 

Maneuverability requirements can actually have several forms. In the sizing of 
a rudder, for example, it may be a requirement that the minimum moment must 
exceed that required to balance an engine out condition. In this case, static control 
power is the issue. As will be shown later, this can directly be expressed as an 
LMI. In other applications, the specification may require that the system exhibit 
a minimum body rate in response to a limit command input. Since most of our 
controllers produce either moments or accelerations, then a specified steady state 
rate represents the output of a dynamic system. These types of specifications can 
consequently be referred to as dynamic maneuverability requirements or dynamic 
open-loop requirements. These too we will show to be expressible as LMI’s. 

In sum, control power requirements are determined by the joint requirements of 
closed-loop internal stability, closed-loop disturbance rejection, and open-loop maneu- 
verability. Each of these performance constraints can be posed as matrix inequalities. 
The joint imposition of many such matrix inequalities provides a mechanism for solv- 
ing the subject optimization problem. 
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C. APPLYING DISTURBANCE REJECTION REQUIREMENTS 



In this section we will formulate the plant/controller optimization problem, 
using an specification as the design constraint to apply disturbance rejection 

requirements, as well as simple closed-loop stability. Recall equation 3.13, which 
poses the 'H 00 performance constraint as a LMI: 



Ri(W,Y) 



AY + Y A' + B 2 W + WB' 2 + B t B[ 
( CY + DW) 



(CY + DW) 
-7 2 / 



< 0, (5.2) 



Assume that the inputs and outputs are scaled such that 7=1, and consider f to be 
the vector of the controller parameters such that W and Y are affine functions of f and 
basis matrices >j, IT,: V' = V'(f ) — Vq + £■_, fOj and W = U'(f ) = W 0 + £i=i 6 'T., 
if £ 7Z S and s = (?r(n -f 1 )/2 ) -f nq. First, using Schur complements, equation 3.13 is 
equivalent to the following LMI: 



WM) := 



AY + YA T + B 2 W + W r B] + (CY + DW) T (CY + DW) £, 

Bj -I 



< 0 . 

(5.3) 



Note that this constraint is affine in the plant matrices A, B i and B 2 . 
Optimization problem 5.1 can now be exressed as: 



Minimize J = c T ( 

Subject to: V' > 0, f > 0, /?,((, f) < 0, (5-4) 



where /?,((,£) is given by either R t or R 2 (equations 5.3 and 5.2). Recall, both con- 
straints are equivalent. To simplify notation, the dependence of the matrix functions 
on f and f will be implicit in the sequel. The controller matrices (V, W) will consis- 
tently be functions of f and the plant matrices (A, B t , B 2 ) will always be functions 
of C. 

As can be seen in equation 5.3, this problem is affine in f for a fixed controller 
K = WY~ l , since the plant itself is affine in f. On the other hand, ecpiation 5.2 
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shows that, for a fixed plant (/t, 7?,, B 2 , C\ D) this problem is affine in £ . Our problem, 
however, is to minimize J over all feasible £ and £. Even though .7 is affine in £, it 
is not clear whether the constraint set {4> = (£,£) : £ > 0, /?(£,£) < 0} is convex. 
This means that the numerical solution of the optimization problem 5.4 may turn out 
to be a local minimum. An important area of future research will be to determine 
whether the set 4> is convex. Presently it can be shown that for a special case of 
the optimization problem 5.4, the set 4> is convex. This case is discussed in the next 
section. 

1. Special Case: Plant/Controller Optimization as a Generalized 
Eigenvalue Problem 

Consider a single parameter plant optimization problem, where 

A = Aq -f £A ] , 

Bx = 7? l0 , 

7?2 = 7?2 0 +£7?2,. (5.5) 

Suppose the matrix pair (/l,, B 2i ) is stabilizable. A physical example of such an one 
parameter problem could be optimization of the size of the vertical tail of an aircraft, 
or the size of the control fin on a missile or a submersible. Now the optimization 
problem can be formulated as follows: 



Minimize : £ 



Subject to: Y >0, £ > 0, and 



Bi 



A 0 Y + YA^ + B 2 W + W'B' 2 + 7?,77{ + \ 
£(A,r + rAj +B 2i W + W'B' 2i ) ) 

(CY + DW) 



( CY + DW)’ < Q 
-7 

(5.6) 



Let c denote a very small number. Using simple algebra and the definition of nega- 
tive definiteness, it can be shown that optimization problem 5.6 is equivalent to the 
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following problem: 



Minimize : £ 

Subject to: Y >0, ( > 0, and 

. [ ~(A,Y + YA\ + /?,, W + W'B' h ) 0 ‘ 

C [ 0 tl 

\ A 0 Y + YA' 0 + B 2 W + W'B' 2 + B } B[ ( CY + DW)' 1 

(CY + DW) -1 j ’ 

Problem 5.7 is in the form of the Generalized Eigenvalue Problem (GEVP) (see 2.1 

and [Ref. 15]): 

Minimize: A 

Subject to: A B(x) — A(.r) > 0, -4(.r) — A(x)\ B(x) > 0,(T'(.r) > 0, 

where /l(.r), B(x). and C(t) are affine in .r. As mentionned in Chapter II, the GEVP 
is a quasi-convex problem, meaning that it has a unique global minimum which can 
be found using efficient numerical techniques [Ref. 14, 15]. 

2. General Case 

Unfortunately, many of the more interesting aircraft optimization problems 
cannot be reduced to GEVP form. This is particularly true for the case where several 
aircraft parameters have to be optimized. However, the optimization problem 5.4 is 
affine in either the vector of plant parameters ([, or the set of controller parameters 
W and Y. This suggests the following approach to solving the optimization problem 
5.4: find a controller (holding the plant constant) , and then minimize the objective 
function while holding the controller constant: 



1. Fix A(C),£(C). Then, 



Minimize: A (over £), 

Y(0 



Subject to: 



0 



0 a/-/mc,0 



> 0 . 



(5.8) 
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2. Fix \V(Z),Y((). Then 



Minimize: J (over (), 
J — c T ( 
Subject to: 0 

0 



0 

diag(0 

0 



0 

0 

-*2(C,0 



> 0 . 



( 5 . 9 ) 



3. Go to step 1 until exit criteria is satisfied. 



Denote the value of A obtained in the first step as the controller margin. 
Given the controller determined in the first step, the second step of the procedure 
then finds the feasible plant with the smallest associated cost. The procedure quits 
when the controller margin becomes so small that the numerical procedure either fails 
to find a new feasible controller after step two, or step two is numerically unable to 
further refine the plant. 

The controller margin has a very rich, significant geometrical meaning. As 
the maximum eigenvalue of /?i (£,£), the controller margin presents the “distance” 
of /?i((,() from singularity, and consequently the “distance” or margin by which 
the closed-loop system satisfies the performance specifications. It could notionally 
be considered to represent the “size” of the set of feasible controllers. The set of 
feasible controllers is either empty or infinite, so “size” is used loosely. The greater 
the margin, however, the greater the range of feasible controllers. This is important 
because the further that /? 1 (C,0 is from singularity, then the more “room” available 
for the second phase of the algorithm to optimize the plant. One would intuitively 
expect that as the controller margin decreases, then the amount of latitude available 
to optimize the plant also decreases. 

Note that both steps of this algorithm are EVP’s and consequently perfectly 
suited for solution by interior point methods. Since the problem is affine in both 
steps of the algorithm, the numerical procedure is guaranteed to converge. But, as 
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discussed earlier, whether the problem is convex jointly in the controller and plant 
parameters is presently not known and is subject of future research. Therefore, there 
is no assurance that the obtained minimum is global (unless the problem satisfies the 
conditions of the special ca se). The above procedure clearly determines a valid upper 
bound for the joint procedure, since a solut ion by interior point methods would never 
leave the joint feasible set. We have not, however, established a means for computing 
a lower-bound. This too is an issue to be pursued by further research. 

A sequence of examples will demonstrate the viability of the proposed 
methodology and illustrate several of its more powerful implications. For the first 
several examples, a single plant variable is optimized. The examples build in complex- 
ity as the methodology is expanded to accommodate the other various performance 
measures. 

Example One- Optimal Vertical Tail at a Single Flight Condition 

This very simple example will demonstrate the formulation of the problem, 
as well as some of the properties that were discussed above. Consider the directional 
dynamics of a typical fighter-size aircraft. The most simple approximation is a second 
order system, with aerodynamics providing both restorative and dissipative forces. 
The wing-body combination of most aircraft is sized and shaped by factors such as 
range, maximum speed, payload, powerplant. Typically, the directional dynamics 
of the wing-body combination include both a stable and an unstable pole. Given a 
specific wing-body combination, the problem for the aero configuration designer and 
control designer is to determine the size of the vertical tail and controller, which, 
together in feedback, provide satisfactory dynamic behavior. For simplicity, we’ll 
consider an all-moving tail so as to reduce the number of degrees of design freedom 
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to one. Because of the single degree* of freedom, this problem is quasi-convex and is 
know a priori to have a unique, global minima. 



The governing differential equation is: 



0 = 



qSb 

L 



2/^ 



w 



~C n J - ~ tC u J + C n — - C n( S 



U 



V 



The notation here is standard aeronautical usage: 



w 

6 

0 

(l 

S 

b 

h 

h 

Cn 0 

V 



(5.10) 



disturbance input 
control deflection 
sideslip angle 
dynamic pressure 
wing reference area 
wing span 

moment of inertia about the vertical ( 2 ) axis 
vertical tail lever arm (distance from CG to aero center of tail) 
non-dimensional change in yawing moment per radian of sideslip 
aircraft velocity 

(5.11) 



The contribution of the tail and wing/body can be separated: 

Cn 0 = C U 0 wb + ^‘0, ^ 



(5.12) 



where V = 4^ is defined as the vertical tail volume. Note that V is a dimensionless, 

bb 

affine function of the vertical tail area A t (or /<!). This is the quantity which we shall 
optimize. Using 5.12, 5.10 can be rewritten as follows: 



where: 



0 

0 



= A 



0 

0 



T I3\W T 13 26 , 



(5.13) 



A = A w b -f A t V 
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(5.14) 
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(5.15) 
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qSbC , 0i 


L /* J 
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qSbl,C li3 ' 






lz 



(5.16) 



2qSbltOi 

Note that for this problem, Ai has eigenvalues at zero and i v (C/^ > 0). 

The following numerical values were obtained using stability derivative data 
from [Ref. 37] and [Ref. 40] for a fighter aircraft at a flight condition of 230 fps at 
sealevel. 



A = 
B i = 
B 2 = 



0 1 

0.0103 0.0018 



+ 



0 0 

-4.1044 -0.7067 



V 



0 

0.0004 

0 



+ 



0 

-0.1765 



V 



0 



+ 



0 

-4.1044 



V. 



The tail volume V was initialized at a value of 0.47. 

The problem was to determine the minimum tail volume which together 
with the feedback controller would stabilize tin 1 plant, and would limit the rms ac- 
tuator deflection and sideslip to ten and two degrees, respectively, in the presence 
of moderate turbulence. MIL-S7S5C establishes moderate turbulence as 10 fps at 
sealevel. B i is scaled by a factor of 1 0 fps /230 fps to normalize the rms value of w to 
1 radian. Since the outputs of interest are and 8, the synthesis model is completed 
by: 



y = 



i 




1 

l 





57.3/10 0 
0 0 



0 



+ 



0 

57.3/2 



8 . 



( 5 . 17 ) 



The output signals have likewise been scaled to guarantee that an rms output of 1 
rad satisfies the performance requirements. 

An interior point method was used to perform the optimization problem 
of posed by algorithm 5.8 and 5.9 to determine: (a) the smallest vertical tail vol- 
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Figure 5.1: Optimization History for Tail Volume (Example One) 

ume, and (b) the associated state-feedback controller which satisfied the performance 
requirements. Recall that the design of a controller which satisfies an bound 

implicitly satisfies internal stability. The final required tail volume was V = 0.0250, 
and the associated controller was I\ = [5.443 10.467]. 

Figure 5.1 depicts the progress of the optimization algorithm, with the 
algorithm commencing in the top right corner. Note that the cost and the controller 
margin decreased monotonically with each iteration. For a single variable problem, 
the weight was set to one, so that the plant cost was identically equal to the tail 
volume. The algorithm forces the cost to decrease monotonically since the terminal 
cost at the end of each step is then the starting cost for the commencement of the 
next iteration. For a single plant variable, the controller margin would be expected 
to decrease monotonically, since the margin reflects the size of the set of feasible 
controllers. Since A w b was not stable, then the open-loop poles predictably moved to 
the right as V was decreased. Consequently, as the poles of the open-loop plant shifted 
to the right, the set of feasible controllers would be expected to monotonically shrink 
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as well (this was not true for multi- variable problems, as will be shown later). The 
process was terminated when the numerical routines either 1) could not find a feasible 
controller during step 1; or 2) the controller margin exiting step 2 was too small to 
numerically permit further refinement of the plant. In this particular example, the 
graph clearly depicts the minimum bound achievable by this method. 

This example clearly demonstrated the viability of the general method. It 
was, however, limited in its applicability, since it only provided the size of the tail 
volume required at a single point in the operating environment, and the fulfillment 
of a single performance criteria. The challenge for the configuration designer is the 
determination of the optimal plant which satisfies diverse performance requirements 
at all points within the operating envelope. The next section will show how the 
method easily expands to accommodate additional constraints. 

3. Plant/Controller Optimization with Multiple Joint Con- 

straints 

Consider now the problem of finding the optimum size of the vertical tail 
which will satisfy three different performance requirements at distinct flight 

conditions. Many of the plant variables in equation 5.16 are dependent on the flight 
condition, including the moment of inertia, the dynamic pressure and the stability 
derivatives. The plant matrices may consequently be dramatically different. Let 
Q i(C), Q 2(C)' an d Q i(C) represent the aircraft dynamics of a single configuration, 
but at three separate flight conditions. Let £, £ and ^ represent the controllers that 
satisfy the three distinct Woo performance requirements represented by /?!((,() < 0; 
/? 2 ((,\<0 < 0; and R 3 ((,£) < 0. These three independent Woo requirements will be 
satisfied if : 



R(U*M) 



RiiU) 0 0 

0 R 2 (U) 0 

0 0 Rz(Ci) 



< 0 . 



(5.18) 
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The optimization problem can therefore be formulated as follows: 

Minimize: J — c T ( , 

Subject to: R ((,£ , <f, £) <0, ( > 0. 

This problem is affine in the plant variable £ for fixed controllers, and affine in the 
controller variables £, £, and £ for a fixed plant. The solution to this problem is the op- 
timal plant which permits satisfaction of each of the three performance requirements, 
and each of the three associated controllers. The problem strategy is similar to that 
pursued above with only minor modification. Since the three controller solutions are 
independent, they can be determined independently to save computational cost, with 
the plants fixed. 

Example. Two- Optimal Vertical Tail at Multiple Flight Conditions 

To demonstrate the multiple flight condition problem, the following three 
flight conditions were chosen for the aircraft in the Example 1: 230 fps at sealevel, 
876 fps at 35 Eft, and 1742 fps at 55 Eft. These conditions correspond to the 
approach, subsonic cruise, and supersonic dash mission phases. Models were again 
synthesized from [Ref. 37] and [Ref. 40]. The horizontal gust magnitude was 10 
fps at sealevel, and 5 fps at the other two conditions. Identical constraints on the 
performance outputs were imposed (2 degrees of rms sideslip and 10 degrees of rms 
tail deflection). 

Figure 5.2 depicts the progress of the algorithm. Note that one flight 
condition dominates the process, and the algorithm quits when the controller margin 
is exhausted at the slow speed flight condition. Intuition is confirmed in that for 
a single variable problem, one would expect the limiting tail volume to be identical 
to the greatest of the three tail volumes when calculated independently. The three 
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Figure 5.2: Optimization History Multiple Flight Conditions (Example 
Two) 

resulting controllers were: K s i ou , = [5.443 10.467]. K subsonic — [31.396 33.350], and 
K supersonic = [38.647 37.949]. This single procedure therefore results in an optimal 
plant configuration and the necessary controller for each operating point. 

The physical structure of our methodology thereby accommodates the sim- 
ple inclusion of multiple plant operating conditions by direct diagonal augmentation 
of the constraint matrix functional. The number of flight conditions is limited only 
by one’s patience in waiting for the computational outcome, and the ability of the 
numerical routines to find viable answers. 

D. APPLYING JOINT DISTURBANCE REJECTION/ STABILIZA- 
TION REQUIREMENTS 

Now consider a problem in which the disturbance rejection requirement is im- 
posed. along with a requirement that the closed-loop poles be placed in a specified 
circle. The norm will again be used to impose the disturbance rejection require- 

ment. Note that minimizing the control power subject to a pole-placement require- 
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rnent is not by itself an interesting problem. Intuitively, some constraint on actuator 
activity is mandatory in the problem formulation. Otherwise, the solution would 
simply allow actuator activity (represented by the state-feedback gain) to increase in 
an unbounded fashion to compensate for the decrease in control power. 

Let a and r define a circle of radius r centered at q = —(cr + r). As discussed in 
Chapter 111, the poles of (A + B?I\) are in the circle defined by a and r, if and only 
if there exists a positive definite solution Y = Y T > 0 such that the following matrix 
inequality is satisfied: 

S( C,0 < 0 (5.19) 

where, 

S(C,0 := (A + B 2 K + aI)Y + Y(A + B 2 K +aI) T 

+{A + B 2 I< + aI)(Y/r){A + B 2 1\ + aI) T . (5.20) 

Using the substitution I\ = WY~ X , this expression is equivalent to both of the 
following matrix inequalities, by Schur complements: 



Sx(Ct) := 

M( (A + atI)Y + Y(A + aI) T + (A + oI)(Y/r)(A + aI) T + \ 
V B 2 W((A + aI)/r + I) T + ({A + aI)/r + I)W T Bj ) 

(B 2 W) t 



b 2 w 

— Yr 



< 0 
(5.21) 



and 

c c \ _ \ (A + B 2 I< + aI)Y + Y(A + B 2 K + aI) T ( A + B 2 I< + al) 1 n 

^ ( A + B 2 I< + aI) T -in v(Y/r) J <U 

(5.22) 

The f>i((\ £) is affine in £, and S 2 (£, £) is affine in but neither is affine in both. Since 
the two expressions are equivalent we can alternatively use them for the controller 
design and the plant optimization. The mechanics of constraining the problem to 
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simultaneously satisfying both the pole placement requirement and the Ti . <*, bound, is 
analogous to the multiple flight condition problem described previously. The problem 
can be stated as: 



Minimize: ,/ = c T ( 
Subject to: T((,£) := 



R(C,0 0 

o S(C,Z) 



< 0, and ( > 0. 



(5.23) 



Here, we again employ our prior approach of dividing the problem into two LMI 
sub-problems. Define two matrix inequalities: 



Ti(U) ■= 



Ri(CO o 
0 Sj(U) 



T 2 ( C,0: = 

We now propose the following algorithm: 



fl 2 (c,0 0 

o 5 2 (C,0 



< 0 



< 0 



(5.24) 



(5.25) 



1. With £ fixed, 



Minimize: A, (over £) 

A I 0 



Subject to: 



0 y 



> 0. 



2. With optimal £ from step 1, 



Minimize: J. (over 

J — c T C 

Subject to: 



0 



0 diag(C) 

0 0 



0 

0 

-t 2 



> 0. 



3. Iterate until termination criteria satisfied. 



Due to the affine problem formulation, both steps may be solved by either inte- 
rior point or convex methods. The constraint and the pole placement constraint 

are just two examples of constraints that can be expressed as LMI’s. Consequently, 
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this method of diagonally augmenting constraints to achieve a joint constraint can 
be used with as many jointly feasible diverse constraints as desired. Examples might 
include the intersection of several circles, or distinct Ti^ Tioo bounds. We will 
later formulate the 7-foo / 'Hoo problem in providing for distinct Ti^ bounds on 
robustness and on performance. 

Example Three- Vertical Tail Optimization with Joint Constraints ( Hoo and Pole 
Placement) 

Consider again the single flight condition problem from example 1, retaining the 
disturbance-to-output performance criteria. MIL-87S5C requires that the closed-loop 
dutch-roll frequency exceed 1 rad/sec and that the damping ratio exceed 0.15. These 
requirements can be (conservatively) satisfied by constraining the poles to a circle of 
radius 87.3, and centered at (-88.3,0). By jointly posing these constraints using the 
above formulation, the plant optimization problem was solved using interior point 
methods. The resulting optimal tail volume was V = 0.0383, with an associated 
controller I\ = [15.96 18.91]. The resulting poles were at —1.500 ± 0.637j (inside 
the circle). Figure 5.3 depicts the progress of the algorithm. Note that the addition 
of the pole placement constraint required a larger tail volume than was achieved in 
Example 1 for the Tt^o constraint alone, where V = 0.0253 was required. 

A significant attribute of this problem is that unlike the previous two, this 
example (or any problem with joint constraints) could not have been be solved by 
bisection on ( and a standard Riccati based H oo controller design. We have now 
demonstrated how the methodology accomodates both stabilization and disturbance 
rejection specifications. Next, we will demonstrate the inclusion of open-loop maneu- 
verability specifications into the problem methodology. 
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Figure 5.3: Optimization History for Joint Tdoo / Pole-Placement (Exam- 
ple Three) 

E. INCLUDING MANEUVERABILITY REQUIREMENTS 

This section presents several methodologies by which open-loop maneuverabil- 
ity requirements can be expressed as LMPs. Maneuverability requirements are very 
much unlike disturbance rejection, where the closed-loop plant must demonstrate a 
maximum acceptable level of attenuation in the presence of disturbances. Instead, 
maneuverability requirements demand that a system demonstrate a minimum ampli- 
fication in the presence of a command signal. Consider the open-loop system depicted 
by Figure 5.4. A typical maneuverability specification has the following form: given 
a maximum control input n — u max , the steady state response of a scalar output r 
must exceed a certain threshold , r thres . Note that u may be a vector of all relevant 
control surfaces. 

Alternatively, consider the closed-loop system of Figure 5.5. The maneuver- 
ability specifications above could equivalently be expressed in the context of this 
closed-loop system: Given an input reference signal r cm( i of magnitude r t h r€S , the out- 
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Figure 5.4: Open-loop Formulation for Maneuverability Constraints. 




Figure 5.5: Closed-Loop Formulation for Maneuverability Constraints. 

put /‘error = r — r C77l( i must be zero in steady state , a??// the control inputs u l must not 
exceed u maXt in steady state. 

Maneuvering specifications fall into two general classes, for which each of these 
formulations are helpful in posing the requirements as LMI’s. As examples, consider 
two different longitudinal maneuverability specifications for a tactical aircraft with 
canards, stabilators and thrust vectoring as longitudinal control effectors. In the 
first case, sufficient control power might be required to provide at least 9 g' > s at a 
specific flight condition, with all effectors fully deflected or deflected no further than 
some effective limit (aerodynamic surfaces may lose effectiveness long before reaching 
a physical actuator limit). Alternatively, a requirement might be that the sum of 
the effectors generate a pitch acceleration of at least 0.25 rad/s at full deflection at 
a specified flight condition. Both of these types of design specifications exist. The 
output r in either case would be scalar, while the input u would be a vector of the 
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three control effectors. 



To understand the difference between these two types specifications, consider 
the state space representation of the open-loop system depicted by Figure 5.4: 

( x = /1((, )x + B 2 {()u 

G = = C(0*+ D(Ou . (5.26) 

Let T open denote the transfer matrix from u to r in Figure 5.4. Then it has the 
following form: 

Topen : r(a) = {C(C)(sI - A(()r l B 2 (() + D{()} «(s). (5.27) 

For the examples we cited above, if r is the pitch acceleration, then D is non-zero, and 
C is zero, annulling the first term of the transfer function matrix. On the other hand, 
if r is the load factor, then the D matrix of the above open-loop system is zero. The 
first case can be considered a static maneuverability specification, while the second 
one a dynamic maneuverability specification. We will see that a static maneuverability 
requirement is easily posed as an LMI. In the case of dynamic specifications, however, 
both the closed-loop and open-loop formulations can be useful. 

1. Static Maneuverability Requirements 

First, let us consider the static maneuverability requirements. These in- 
clude constraints where the modeled open-loop system has a non-zero D and zero C 
matrices. An LMI formulation for the requirement is evident by inspection: 

D(Qu mQX - r thres > 0. (5.28) 

Multiple similar requirements could be diagonally stacked. This type of specifica- 
tion can also referred to a static control power constraint, because it frequently is 
expressed as the static moment required from a controller or set of controllers at a 
specified condition. These conditions can either be equilibrium or non-equilibrium. 
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The specification itself can have units of force or moment, or translational or an- 
gular acceleration in response to a limit control deflection. The next example will 
demonstrate how specifications of this type can simply be accommodated by our 
methodology. 

Example Four- Vertical Tail Optimization with Static Moment Requirements 



A specification that frequently sizes vertical control surfaces is the require- 
ment that adequate control power be available to balance the moments generated 
by adverse thrust conditions, such as engine out. Consider the vertical tail sizing 
problem discussed above. In addition to the previous Ti 0 0 specification for turbu- 
lence rejection and stabilization, let us now also impose the static requirement that 
the tail be sized so as to be able to generate a moment adequate to balance 40,000 
ft — lb of torque at full deflection (30 degrees) at our nominal flight condition. This 
requirement is representative of the torque necessary to balance an asymmetric thrust 
condition. Furthermore, it can simply be posed as the following LMI: 

D s tatic(V) := qSbu max V - r thres > 0, (5.29) 

where u max = 0.52 rad , and r thres = 40,000 ft — lb. 

Let £ = V. Since the constraint D sta tic{0 > 0 is not relevant to the 
search for a feasible feedback controller, it does not need to be considered during the 
controller optimization phase of the process. Therefore, the algorithm can now be 
posed as follows: 

1. With C fixed, 



Minimize: A, (over £) 

A I - R, 0 



Subject to: 



0 



Y 



> 0 . 
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2. With optimal £ from step 1, 



Minimize: J, (over ( 
J — c r ( 

Subject to: 



0 



0 diag(C) 

0 0 

0 0 



0 0 

0 0 

- /?2 0 

0 D s tatic{ C) 



> 0 . 



3. Iterate until termination criteria satisfied. 



Figure 5.6 depicts the progress of the algorithm, with the starting point at 
the upper-right end of the trace. This graph depicts two significant issues. First of 
all, the final required value was V = 0.14, rather than the value of 0,025 which was 
required when the Hoo constraint alone was applied. This answer is in fact identical 
to that obtained if we had alternatively solved the linear equation: 

qSba maT V 1 thres — 0 . 

Secondly, the controller margin at the conclusion of the optimization is several orders 
of magnitude greater than that for any of the previous problems. This indicates 
that the set of feasible controllers is comparatively large, and that the final answer 
was independent of closed-loop dynamic issues and was instead driven by the open- 
loop maneuverability requirement. This is consistent with the industry’s practical 
experience that directional control power is generally sized by considerations such as 
thrust asymmetry rather than turbulence rejection. 

The kink in the plot for the joint specification is caused by the nature of 
the graph. The x-axis reflects the result of the controller optimization phase of the 
algorithm, while the y-axis reflects the result of the plant optimiztion. The static 
maneuverability constraint is only applied during the latter phase, and so when the 
static constraint boundary is reached, the controller phase finds a new controller with 
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Figure 5.6: Optimization History for Vertical Tail Volume with Static 
Constraint (Example Four) 

a smaller control margin, but the plant optimization phase can not decrease the plant 
cost any further. The result is an abrupt kink in the plot. 

We have consequently demonstrated how static maneuverability specifica- 
tions can be accommodated into the methodology. 

2. Dynamic Maneuverability Requirements 

Now consider the problem of posing dynamic maneuverability specifica- 
tions, where for the open-loop system D = 0, and C is a rank one row vector. As 
mentionned above, these types of requirements can be posed either in an open-loop 
or closed- loop formulations. 

a. Dynamic Maneuverability Requirements: Closed-Loop For- 
mulation 

We will first show how a maneuverability specification can be posed as 
an LMI by means of the closed-loop formulation. Let T U%W (C 1 ,C ) represent the closed 
loop transfer function from exogeneous disturbance w = r to the control command 
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u t . Here vve are interested in the steady state response of the control command u l to 



the constant disturbance input w = r t f ires . In particular, absolute value of i i t must 
not exceed u maXt in the presence of w ~ r < / ires : 



^i(^) 



te(.s) 



< 



5=0 r thres 

Two approaches were considered for formulating this constraint as an LMI. 

(1) An Hqo Approach 

First, using the power interpretation of the norm for a sta- 

ble SISO system, this requirement can be rewritten as a constraint on the norm 



(5.30) 



oiT UtW (G X ): 

< l|T„,„(e ,C )|U < (5.31) 

Notice, if the norm of T U|U ,(£y X ) occurs at a frequency other than zero, the 

constraint 5.31 provides only a sufficient condition for meeting the requirement 5.30. 
However, it has been our experience that for the class of problems involving integral 
control, the norm of T U%W {Q X ) occurs at the origin. 

Consequently, the 'H co specification previously applied for dis- 
turbance rejection can now be also applied to meet dynamic maneuverability require- 
ments. Depending on the problem, these requirements must be satisfied at the same 
flight condition as the disturbance rejection requirements (by including the command 
signal in the exogenous input vector w ) , or at a different more critical for maneuver- 
ability condition. 



Example Five- Optimization of Multiple Surfaces with Open and Closed-Loop Perfor- 
mance Requirements 



This example problem has several objectives. First of all, it is 
a problem where the cost function is dependent upon multiple plant parameters and 
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thus provides a much more rigorous test of the proposed methodology. Secondly, a 
multiple variable problem permits using a variety of the initial values for the plant pa- 
rameters. This will help determine whether the algorithm will terminate at different 
answers, perhaps giving some insight into the convexity of the multiparameter prob- 
lem. Recall, the problem is convex in the single parameter case. Finally, a problem 
was needed with both open and closed-loop performance requirements. 

Because of the availability of component stability derivative data 
for the F-14 aircraft, a longitudinal control problem similar to the one in Chapter IV 
was selected. The vehicle parameters to be optimized were the normalized control 
powers of both the horizontal stabilators, and the direct lift control (DLC). Conse- 
quently, let the vector of plant parameters ( be defined as: 

C = (Ci, C 2 ] T := 

The cost function weights on the plant parameters were arbitrarily chosen to be 
c = [3, l] T . Recall, these weights can represent normalized cost in dollaxs, weight 
in pounds, etc. The reference input of interest was commanded flight path angle 7 , 
and the outputs to be regulated were the actuator deflections, the angle of attack 
error, and the flight path angle error. The disturbance input was a vertical gust. The 
control inputs were stabilators and DLC deflection (thrust was assumed constant), 
and the full state vector was assumed to be available for feedback. Thus, the problem 
was stated as: 

Find the plant parameters (£) and a state- feedback controller (£) which 
minimize the total cost J ~ c r ( of the longitudinal control effectors, 
subject to the following dynamic requirements: 

• Step response — The controller must track a step flight path angle 
command, 7 cm d, with no steady state error in a or 7 . 



Cr 



a 



Ldlc 



^ stab nomtnal ^ ® ^^nomtnal ■ 



106 



• Closed-loop stability — The closed-loop system must be stable. 

• Closed-loop performance In the presence of a vertical gust distur- 
bance, Wgusti with a magnitude of 5 //as, the stabilator deflection 
should not exceed 20 degrees, the DLC deflection should not exceed 
40 degrees, and the angle-of-at tack error should not exceed 1.5 de- 
grees (all quantities rm. s), 

• Open-Loop maneuverability — The plant must be able to generate a 
flight path angle (7 = 6 — a) of 3 degrees with the DLC and stabilator 
deflected no more than 40 degrees and 20 degrees, respectively. 



These requirements can be satisfied by the joint imposition of 
the following Hoc constraints: 

1 . The step response requirement will be satisfied if and only if 



II T,„ emd (G X )||oo < co, where r, : = 



. (y error 7 error •t'J' 



2. The closed-loop performance will be satisfied if and only if 



II T !jWgu „(Q X )||oo < where z 2 : = 



t>stab &DLC 



20 deg' 40 deg 1.5 deg 



3. The open-loop maneuverability requirement will be satisfied if 



II T^ cmd (Q X )IU < 



3 deg 



where C 3 



fistab bpLC 1 J 

20 deg' 40 deg 



A sufficient condition then for the satisfaction of these three constraints is the single 
constraint: \\T :w (Q X )||oo < li where 

to := [w gusi , 7 C md} T = [5 fps, 3 deg} 7 

[ t>DLC a nor ^rro rYT 

^ 40 deg 1.5 deg' cj s c?s J 1 
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and and C2 are any finite positive numbers. This constraint also implicitly guaran- 
tees internal stability. This constraint later leads to the formulation of the synthesis 
model. 

The choice of optimization parameters was driven by the unusual 
character of the Direct Lift Control. This is significant because the DLC control 
power is neither linear in deflection nor proportional to the size of the DLC surfaces. 
Consequently, we must optimize a metric whose influence on the plant dynamics is 
linear. Normalized control power was therefore chosen as the optimization parameter 
in order to adhere to the assumption that the plant dynamics be reasonably modeled 
by a linear system. In the actual aircraft implementation, the controller will have to 
include a nonlinear schedule on the DLC deflection in order to achieve the commanded 
control power. Since the stabilators are a conventional aerodynamic surface, their 
control power is in fact linear with both deflection and surface area, and any one of 
several optimization parameters could have been chosen (tail volume, surface area, or 
absolute control power). To facilitate the comparison, normalized control power was 
chosen. 



To proceed with the problem description we need to define the 



following terms using flight dynamics conventions: 



u 

a 

V 

9 

c. X, 

C*. 

Q 



aircraft velocity resolved in the body x-axis 

angle of attack 

pitch rate about body v/-axis 

pitch attitude 

~ non-dimensional trimmed force/moment coefficient, 

where X is lift (L), drag (D) or pitching moment (M) 
non-dimensional stability derivative, 

where y ^ t is a nondimensional state or control deflection 
dynamic pressure 
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s 



wing reference area 
c wing mean chord 

m := mass 

I yy moment of inertia about the lateral (y) axis 

V := aircraft velocity 

fr L> :=■ ^ u ’(4Efey i. g .n£fl. turbulence variance 

(j -y := maximum flight path angle command amplitude 

Ltab ~ — r -- : ^ stabilator lever arm (distance from CG to aero center of stab) 

L L stah 



Next, the aircraft stability derivatives were expressed as the sum of their wing/body 
(wb), stabilator (stab), and DLC contributions [Ref. 40]: 





~ C Da 


(5.32) 


° L °«. b 




(5.33) 


c Ma 

^ wb 


:== (■ ~ lstab ^ L sta b 


(5.34) 


C ^ b 


* = ^ L q ~ 2 lstab G Lstab 


(5.35) 




* btq 2 lstab ^ Lstab 


(5.36) 


C ^ wb 


: = ^L n + 2 lstab C Lttab 


(5.37) 


C "° wb 


' ^ A/ q 2 l s ( a b Cs Lstab * 


(5.38) 



Note that since the DLC perturbs the nominal flow field, it has no contribution to the 
A matrix, but instead represents raw cont rol power, influencing only the B matrix. 

The linear aerodynamic model of F-14 is derived next, followed 
by an outline of how it was used to form a synthesis model. The state derivatives 
of the core aerodynamic plant were ,r = [?/ o q 0) 1 . Let T be a rotation/scaling 
matrix: 



T := QS 



— cos(o 0 ) 



— sin(oo) 
0 



sin(o 0 ) 
- cos(oo) 



0 



0 

0 

c 



where o 0 is t he trimmed value of a. 
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Let I m represent the inertia/ a matrix. Then 



mV 






' 0 


0 


0 * 


0 ' 


mV 




C rp 

2 V 1 


0 


Ci a o 


0 


lyy 






0 


Cm q 0 


0 


1 . 








0 


0 


0 



Im := 

Now, the state matrices of the plant have the following form: 
= Aaeroo T ^oerojCl T AaeroiC 2 



- I 



-1 






c. 



A, 



- Cl, 



C 



2C d ,+C Du V~ 1 

2C Li + CuV- 1 

. 2 Cm, + Cm u V~ x c . a / Qu) 

0 0 —mV sin(oo) 
0 0 mV cos(oo) 
0 0 0 



0 



L °wb D < ( - L 9 u ,6 2V' 

Ca/„ C M<, wh W 



\ 



+ 



0 0 



1 



-mg cos (0 o ) 
-mg sin(0 o ) 
0 





■ 


' 0 


0 


0 


0 




’ 0 


0 


0 


0 ■ 


+c 


CL„. b T 


0 

0 


1 

Istab 


9 

9 

“ 2V J 


0 

0 


Cl + Cl di .c 


0 

0 


0 

0 


0 

0 


0 

0 




1 


3 


0 


0 


0 




. 0 


0 


0 


0 . 



{2 



(5.39) 



B a 



— Baeroo T ^aeroi Cl T fiaer02^>2 



■ 0 


0 ■ 






0 


0 ■ 


“ 


0 

0 


0 

0 




Cl. m T 


1 

Istab 


1 

o o 




. 0 


0 . 






0 




0 . 



r-l 





" 0 


C D D lc 1 C Ldlc 


■ 


Cl dlc T 


0 


1 






0 


C M Die ! LdLC . 








0 0 





CV 



Cl + 



(5.40) 

Note that these matrices include dynamic coupling and gravity terms, as well as 
the aerodynamic forces. This model was verified by comparison with the nominal 
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state matrices (C — [1, 1]^) obtained from the linearization of the nonlinear model 
described in Chapter IV. 



Q was formed: 



Using the aerodynamic plant matrices above, a synthesis model 
X = ,4.7' 4" B\W -p B 2 w 



Q = 



= C x 4- D 2 u\ 



with w and z defined above, and and 



A = 



B, = 



Bo = 



C = 



Do = 



l aeroQ 



0 

0 



1 0 0 

-1 0 1 



0 0 
0 0 
0 0 
0 0 
0 0 
0 0 



+ 




A a er oj 




0 

0 

0 


0 ' 

0 

0 








0 


0 




0 


0 0 


0 


0 


0 




0 


0 0 


0 


0 


0 



Cl, (5-41) 



*7 a Aaeroo 



0 

0 



0 , 2 ) 



0 

0 

0 

0 

0 

( 7 -. 







0 ■ 


4- 


1^*0 ^aeroo ( • , 2 ) 


0 

0 




0 
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0 




0 


0 



Ci - 



0 

1 



0 

Urrtai2 
0 0 

0 0 

0 



(5.42) 
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(5.43) 
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(5.44) 
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0 


0 


() 


0.00001 


0 
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0 


0 




0 


0.00001 





(5.45) 



Note, the second column of A shows up in B\ because the plant 
sees a sharp edged perturbation in the vertical airmass (6io) as a perturbation in 
angle of attack (da = dw/V). (Here A(:,2) represents the second column of A). 



Note that the elements of w were scaled by a t to achieve ||u >||2 < 1. As a result, 
the synthesis model was scaled to ensure that any state-feedback controller C — A 
satisfying || T ZW (Q ,C )||oo < 1 also satisfies each of the specified design requirements. 
The scaling of the integral errors was chosen to be small (1 x 10~ 5 ) in order to limit 
the conservatism of the Tioo constraint. Adjusting these values principally influences 
the time constant of the washouts. 

Figure 5.7 depicts the optimization history for this problem. 
The top graph depicts the progress of the controller margin with each iteration. The 
second graph shows the progress of the total cost with each iteration The lower graph 
depicts the progress of the plant parameters. Three optimization runs are shown, 
initialized at values of (o = [10, 10] 7 ,[0.12, 50] r , and [1, 20] 7 . The plots were 

shifted horizontally so as to terminate at the same iteration count. 

This example has a number of interesting features. First of all, 
note that the final output value was independent of the initialization conditions. 
While this by no means proves the existence of a unique minima in the feasible set, 
it is an encouraging result. Secondly, unlike the single variable problem, which was 
known to be quasi-convex, the controller margin does not decrease monotonically with 
each iteration. Finally, during the progress of the optimization, the stab control power 
actually falls below its convergence value. What is significant, however, is that the 
total cost continues to decrease monotonically as the stab control power overshoots its 
optimal value and then corrects. About a dozen permutations of this problem were run 
with various weighting vectors and differing performance specifications. The following 
identically significant behaviors were observed: 1) the output values were always 

independent of the initialization vector Co; a,nd 2) the total cost always decreased 
monotonically. 
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Iterations 




Figure 5.7: Optimization History for Longitudinal F-14 Problem with Mul- 
tiple Initial Conditions (Example Five) 

Another issue of significant importance is actuator activity. It 
might he expected that the optimization routines minimized control power at the 
expense of unacceptable increases in actuator activity. This turned out not to be the 
case, since actuator deflection was constrained as a part of 'Hr Xl problem formulation. 
Figure 5.8 shows the broken-loop control responses for the stab and DLC actuators. 
With cross-over frequencies in the range of one to three rad/s , t he actuator demands 
for this problem are about one order of magnitude less than modern flight control 
actuator capacity. 



113 




Figure 5.8: Broken-Loop Control Response for Longitudinal F-14 Problem 
(Example Five) 

(2) A Lyapunov Approach 

The second approach using the closed-loop formulation was to 
consider the closed-loop transfer function from the command reference signal to each 
control as an output, and explicitly limit the steady state value. Let K, be the 
row of the state-feedback gain matrix corresponding to the control input u t , and let 
._ . The closed-loop transfer function from iv to i/, is: 

r thre$ 

T UiW (s) = A, (si — (A 4- B 2 I\ )) (5.46) 



Enforcing 



yields: 



T u , w ( 0) < ?/, 

t] 1 + I\ t (A + f?2A ) 1 B\ > 0. 



Note that since ?/, is scalar, this is equivalent with the expression: 



det (r/, + K,(A + B 2 K) > 0. 



(5.47) 



(5.48) 
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Recall Schur's determinantal formula [Ref. 41], that given: M 
det( F) 7 ^ 0 : 

det(M) - det(F) det (j - HF~ X G ) . 



F G 
II J 



and 



(5.49) 



Consequently, 
det 



~{A + B 2 K) b x 
A'. Tj, 



= det (?/, + A ', ( A + B 2 I<)~ x B x ) det (-(.4 + B 2 I<)) 

B\ A', 



= det —{A + B 2 I\) — 



det (?/,) . 



Equation 5.48 is consequently equivalent with: 

det(r/,) 



det ( — (/l + B 2 1\)) 



det -(>1 + B 2 K) - 



B x I\, 



> 0 . 



(5.50) 



Note that det (r/,) > 0. Furthermore, assume (.4 + B 2 K) is stable, which implies that 
det { — {A + B 2 I\)) > 0. The constraint can now be expressed as: 



det ^-{A + B 2 I\) - > 0- (5.51) 

Note that (/l + B 2 K + Ai A ' .i j stable is a sufficient (but not necessary) condition for 
satisfaction of this scalar inequality. If we again use the controller parameterization 
A = ICy -1 , this can be expressed by Lyapunov’s equation as the LMt: 

T T t B x W, + \V T Bj 

AY + YA t + B 2 W + \V T Bj + — i — A < o. (5.52) 

V: 



An example problem using this formulation were not completed, however, the codes 
supporting this approach are included in Appendix I). 

b. Dynamic Maneuverability Requirements: Open-Loop For- 
mulation 

In this section we propose a methodology for inclusion of open-loop 
maneuverability constraints in a strictly open-loop formulation. As discussed earlier, 
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such constraints may include maximum pitch rate, roll rate or yaw rate requirement 
with all the control surfaces set at their maximum deflections. It turns out that these 
constraints can be derived using the open loop linear plant matrices such as A aero 
and B aero introduced in the previous section. 

Assume that the scalar output z = r is also represented by one of the 
states of the system, With all other states zero, the maximum steady state value 
of x x can be expressed by: 

0 — Ap it ).r, jiimaxi (5.53) 

where A( M ) denotes the i-th diagonal element of A , and B 2{t } denotes the corre- 
sponding row of B 2 • Note that A( M ) must be negative in order to represent a stable 
equilibrium condition. The open-loop constraint can now be posed as the inequality: 

A ( p thres d” B 2 0. (5.54) 

This is now affine in our plant matrices, and the plant optimization constraint can 
be posed as the LMI: 

A(| tt ') ( £ 'j+'thres ^( i ; )(C)^max ^ 0. (5.55) 

Note that the assumption can be relaxed that r be represented by a system state. 
This is because if z — Cx , then a similarity transform S exists which can make ~ a 
state x t of an equivalent system: 

x = Ax + B 2 u : ~ = x t . (5.56) 

Furthermore, if A and B 2 are affine in £, then A(C) = SA(()S~ l and B 2 {£) = 5 . 62 (C) 
are affine in (\ 

Constraint 5.55 can therefore be posed jointly with any of the other 
proposed constraints, and the plant/controller optimization problem solved as before. 
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Because this constraint is truly open-loop, and only applies to the plant optimization 
phase of the routine, it can be omitted from the constraints imposed during the 
closed-loop controller optimization as with constraint 5.29. 

Example Six- Optimization of Multiple Surfaces with Open and Closed-Loop Perfor- 
mance Requirements 

Let’s revisit the F-14 longitudinal example. This time consider the 
additional open-loop maneuverability requirement that adequate control power exist 
to generate at least 0.5 rad/sec of positive pitch rate with the stabilator deflected 20 
degrees from the trimmed value, and the DLC neutral. Consequently, stab max = 
radians and equation 5.55 now becomes: 

- ^aer O(3 , 3) (C)(0.2rW) - B acr0{3 i , ( C ) yy > 0. (5.57) 

This LMI was included in the plant optimization phase of the plant/ 
controller algorithm. Figure 5.9 depicts the progress of the algorithm. The addition of 
this open-loop maneuverability constraint resulted in an increase in the required size 
of the stabilator from 0.12 to 0.34 of its normalized value. The DLC size predictably 
remained the same as in Example Six. The results shown in Figure 5.9 indicate that 
the closed-loop TYoo performance constraint was responsible for sizing the DLC, while 
the open-loop maneuverability constraint was responsible for appropriately sizing the 
stabilators. The abrupt change in the controller margin is for the identical reason as 



that explained in Example Four. 




Iterations 




Figure 5.9: Optimization History for F-14 Problem with Open-Loop Con- 
straint (Example Six) 



Example Seven- Optimization of Multiple Surfaces with Open and Closed-Loop Per- 
formance Requirements and Directed Thrust 



The objective of this example is to demonstrate that more uncon- 
ventional control effectors can be easily incorporated into the proposed methodology. 
Therefore, in addition to the aerodynamic control surfaces, provision was made in the 
model for the deflection of the engine exhaust to provide additional moment (directed 
thrust). In this simplified model the thrust is set to the trimmed value of 13,118 Ibf, 
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and ancillary nonlinear effects of thrust vectoring, such as entrainment, are ignored. 
The commanded thrust deflection is set to be equal to the stabilator deflection, with 
similar actuation rates, such that S t i irust = 6 sta b- Consequently, the controls problem 
remains a two-input problem. 

We first discuss incorporation of the directed thrust into the synthesis 

model. Define the following parameters: 

To := trimmed thrust value ( Ibf ) 
l e := engine lever arm (ft) 

0 e := thrust deflection angle (rad), relative to body axis 
0 €q := nominal installed thrust deflection angle (rad). 

Using above notation and the notation of the previous section, the nonlinear directed 

thrust contribution to the state derivatives can be expressed as: 
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Linearizing equation 5.58 about a nominal flight condition results in the following 
expression: 
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(5.59) 
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Incorporating directed thrust in the aircraft, dynamics results in the new expression 
for Baero defined in equation 5.40: 
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(5.60) 
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Note, whereas B aerOQ had previously been zero, it has now includes the directed thrust 
contribution. 

The open-loop maneuverability specification given by equation 5.57 
retains the same form. When expanded, this inequality is now: 

- A aeTOi3 3) (0qmax - B aerO(3 l) (0tsta bmai - ~ ~ ^ ( 0 e - 0 eo ) > 0. (5.61) 

*yy 

The expectation was that significantly less stabilator control power would be required 
due to the ability of the directed thrust to provide large moments. 

As can be seen from Figure 5.10, the methodology determined that 
essentially no stabilator control power was required in order to meet the specifications, 
and a controller was found which satisfied the requirements using directed thrust and 
DLC alone. Note that the availability of the directed thrust did not decrease the 
amount of DLC control power necessary to meet the requirements. This was to be 
expected since the influences of these two control inputs on the plant dynamics are 
nearly orthogonal. 

This example demonstrated that that diverse control inputs, such 
as directed thrust can be handled by the methodology we've proposed. However, 
additional constraints will have to be imposed to guarantee a satisfactory solution for 
flight conditions where thrust setting is not constant, such as terminal area flight. 

In this section we have shown that the proposed methodology can 
easily accomodate various static and dynamic maneuverability requirements. In par- 
ticular, it was demonstrated that these requirements can be formulated as LMFs and 
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Figure 5.10: Optimization History for F-14 Problem with Directed Thrust 
(Example Seven) 

included in the plant/controller optimization algorithm together with the closed-loop 
performance and stability constraints. 



F. ACCOMODATING MODEL UNCERTAINTY 

The hazards associated with under-designing the control power are extreme, 
and yet the answers determined by the methods above presume perfect knowledge 
of the linear plant. As a consequence, sound engineering practice would demand 
that provision was made in the design process to ensure that inaccuracies in the 
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linear synthesis model would not be responsible for the gross under-design of the 
control surfaces. If one’s confidence in the aerodynamic derivatives was within ten 
percent, then the temptation might be to simply pad the tail size by ten percent. This 
methodology would fail to recognize that it is the dynamics of the whole vehicle which 
are uncertain, and might result in sub-optimal allocation of the control power to cope 
with the other uncertainties in the knowledge of the plant. Because of the small gain 
theorem (Theorem 3.7), the methodology of section C was easily extensible 

to the problem of providing robust control, and optimization of the vehicle control 
power which would guarantee both robust stability and fulfillment of the performance 
objectives. 

This proves to be an interesting problem, because the formulation of the syn- 
thesis model for plant optimization with a robust stability constraint is significantly 
different from the constraint posed above. Consider again the uncertainty model 

for longitudinal aircraft dynamics presented in Chapter IV, in which parametric un- 
certainty was modeled by uncertainties on the total lift, drag and moment gener- 
ated by purely aerodynamic forces. Figure 4.1 depicted the inputs and outputs of 
the uncertainty block. Consider the linearization of that nonlinear plant, replac- 
ing F grav and Fd yn with A grav and Ad yn - Furthermore, let A aero represent that the 
aerodynamic influences such that A aero introduced in equation 5.39 has been decom- 
posed into its aerodynamic, gravity and dynamic coupling contributions, such that 

Aaero — Ag rav + Ad y n T F W \)A aero * 

The uncertainty inputs and outputs to the linear system can then be represented 
as depicted in Figure 5.11. The system depicted by Figure 5.11 can be posed in a 
state-space representation: 



Q A ~ 



i = (A 

aero (C) + B 2 (C)I\ ) a ' + R u ,bW$ 

Z6 = {A aero {() + B 2 (()K)x 



(5.62) 




Figure 5.11: Linearized Uncertainty Model 

By the Small Gain Theorem, the rlosed-loop system will be stable for all { A : || A||oo < 1 
if and only if \\T Z/]Wfi < 1. This constraint can be expressed by the LMI: 



R a(U'):= 

( d aero (C)V + J , /t ae ro(C) / + \ 

l b 2 {Ow + wb 2 { a + Ru,ar wb ) 

(Aa'roiOY + Ih((W) 



(/i aero (C)r + j3 2 (c)iTr <0 

-I 

( 5 . 63 ) 



d’he problem is different from those encountered previously in that this single matrix 
inequality is affine in both the controller parameters (H 7 (£),) (£)) and the plant 
parameters £. This LMI can consequently be used for both phases of the optimization 
procedure. 

Time precluded the completion of a design example using this formulation, 
though the scripts which support this problem are included in Appendix D. 



G. GENERAL COMMENTS 



This section presents several diverse comments on the methodology presented 
above. 

1. Interpreting the Results 

What does the output of this methodology mean? Two mathematical issues 
are significant. First of all, though each of the two phases of the method are affine 
problems, and despite considerable effort, we have been unable to mathematically 
establish that the feasible set for the joint controller/ plant optimization problem is 
convex. Consequently, absent a proof of convexity of the feasible set, the existence 
of lower cost solutions can not be discounted. Secondly, a feasible solution to the 
appropriate LMI is both necessary and sufficient for the existence of a state-feedback 
controller satisfying either the constraint or the pole placement specification. 

When more than one constraint is jointly imposed, or the constraint 

is imposed jointly with another constraint, such as pole placement, then a feasible 
solution to the joint LMI is clearly a sufficient condition for a feasible controller. 
It is no longer, however, a necessary condition [Ref. 25]. Again, absent a proof of 
necessity, controllers might exist which would permit further reduction of J . The 
output J = c T ( opt is consequently an upper-bound to the optimum value of J . 

2. The Example Problems 

It is important to mention that the first several example problems could 
have been solved by easier means. These examples were not intended to suggest 
that our methodology should be used to solve these types of problems, but rather to 
demonstrate the methodology on small easily visualized problems. The answers in fact 
confirmed our intuition into these simple problems. The power of the methodology is 
its direct applicability to much more complex problems with multiple variables and 
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joint constraints, for which no other direct method exists. 

3. Limitations of the Methodology 

It is important to identify the limitations of the methodology. The above 
examples demonstrate the viability of the method, and its flexibility to simultaneously 
adjust to diverse specifications. There were however two assumptions which implicitly 
limit its application: 

1. The linear model faithfully represents the dynamic character of the plant 

2. The plant could reasonably be expressed as an affine function of the optimization 
parameters. 

Neither of these assumptions was considered to be significantly limiting, as there are 
a wide range of examples for which they are both reasonable. It is worth noting for 
the reader one example for which an aircraft would not be affinely dependent upon a 
control size. In the case of a closely-coupled canard, the affine assumption would not 
be reasonable, as the size of such a canard can have a dramatic effect on the influence 
coefficients of the surfaces located in its wake. 

Furthermore, there is one other significant explicit limitation — the exis- 
tence of a feasible controller. Several example problems were attempted for which no 
feasible controller could be found. This was most common when multiple joint spec- 
ifications were imposed. The methodology cannot guarantee a priori the existence 
of a controller in the presence of conflicting, or mutually incompatible, performance 
criteria. 

4. Other Applications 

The focus of both the discussion and the examples has been the optimiza- 
tion of control power, i.e. those items whose principal influence manifests itself in 
the B matrix of the state-space representation. Furthermore, the examples have each 



suggested that the size of surfaces might he the principal figure of interest. The ap- 
plication of the methodology is not, however, restricted to those features of a vehicle 
which represent control power. Any feature whose contribution to the dynamic system 
can be posed in an affine manner can be included in the vector of plant parameters, 
and consequently be reflected in the cost function. Strakes and fixed fins would be 
examples of features which might only have a contribution in the A matrix, but are 
likewise perfectly suited to the application of this method. Occasionally, destabilizing 
features such as blisters, antennas or external stores must be appended to a vehicle. 
The methodology can then be applied to find the maximum acceptable size of the 
feature by including the negative contribution of the feature in A((), and finding the 
minimum negative value of the sizing parameter. Finally, recall that in the example 
problems that the tail volume was defined as the normalized product of the surface 
area, and its distance from the eg . The influence of a feature is consequently also affine 
in its position as well as its size, and so the methodology might instead be applied 
to optimizing position rather than size for some applications. The method presented 
in this chapter is consequently broadly applicable to a wide variety of problems not 
demonstrated here. 

H. FUTURE DIRECTIONS 

The following subjects present the foundations for future work. 

1. Convexity Issues 

Though the value of the above methodology does not hinge on the problem 
being proven to be convex, convexity remains an interesting subject. This is partic- 
ularly true if the method is to be expanded to other applications. One particularly 
interesting direction to be pursued is the method’s close resemblance to D-K itera- 
tion [Ref. 34]. D-K iteration is a method by which robust controllers are designed 
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by iteratively designing a controller and then performing a similarity transform on 
selected inputs and outputs to scale for robustness. Though the method has been 
recognized and used for some time by the controls community , special cases of the 
problem were just recently proven to be convex [Kef. 42, 43]. The similarity of these 
two problems tenders some hope that the problem we’ve posed may yet prove to be 
convex. 

In the event that general convexity can not be demonstrated, perhaps the 
mathematical nature of the problem can further be refined to enhance our understand- 
ing of the result. Can a lower bound be computed? Is the result a local or global 
minimum? Are there other special conditions for which convexity of the problem can 
be assured or imposed? For example, if one could determine the smallest convex set 
which contained the feasible set, then a lower bound could be found by minimizing 
the cost function over that convex set. A lower bound close to the upper-bound found 
through our iterative methodology would be of tremendous practical value. These are 
subjects which each warrant further investigation. 

2. Other Convex Performance Constraints 

A second limitation to the above approach was its restriction to those con- 
vex constraints for which an I, Ml formulation exists. A number traditional perfor- 
mance metrics are convex problems for which an LMI formulation does not presently 
exist [Ref. 13], including overshoot, rise-time, settling time, and response bandwidth. 
The above methodology can and should be expanded to include these types of per- 
formance specifications. 

I. CONCLUSIONS 

While establishing the minimum control power requirements for a aircraft has 
always been a concern, it is now a core design constraint with the advent of aircraft 
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whose open-loop dynamics may be unstable. With an unstable platform, the control 
effectors must now not only provide the capacity for adecpiate maneuverability, but 
also provide stabilization and disturbance rejection. For this type of vehicle, if an 
control actuator encounters a deflection or deflection rate limit in providing maneu- 
verability, it reverts to its natural dynamics in response to any disturbance. Missteps 
in this arena have been well documented. The loss of the prototype Grippen on its 
sixth flight was attributed to saturated control rates in an environment where linear 
aero and flight dynamics prevails [Ref. 44]. To under-design the control power is to 
court disaster. To compensate for the hazards by over designing the control power is 
to forfeit all the benefits offered by reduced static stability (low monetary cost, high 
maneuverability, low drag, low signature, low weight). 

Direct numerical methods have been needed in which performance requirements, 
including actuator rates and deflections, are the inputs to a methodology which then 
can simultaneously determine both the lowest “cost” configuration and its accom- 
panying controller. This chapter demonstrated that many common flying qualities 
specifications can be posed as Linear Matrix Inequalities. These included stabilization 
requirements, disturbance rejection requirements, and static and dynamic maneuver- 
ability requirements. Furthermore, a iterative method of optimizing a plant config- 
uration was demonstrated when the performance constraints can be posed as Linear 
Matrix Inequalities. This work is at a threshold, having demonstrated a viable means 
for solving a significant subset of control power problems, and suggesting an approach 
to pursue the larger set of convex performance constraints, which predominate the 
flying qualities specifications. 



J. RECOMMENDATIONS 



It is recommended that the following steps be taken to further the contribution 
of this work: 

1. Procure commercial interior point codes when they become available. The point 
here is to separate the influence of the numerical methods from the application 
of the engineering formulation. The coding of the interior point algorithm in 
Appendix B restricts the engineering application of the above formulation in two 
ways: ( 1 ) it is slow due to the choice of M ATLAB as the programming language, 
and (2) the code demonstrated some irregularities, such that there were some 
problem geometries for which the path of centers was unstable. Consequently 
some interesting feasible example problems were attempted which the available 
interior point code would not solve. 

2. Extend the general methodology to other performance measures which have 
convex solutions, but which do not currently have LMI formulations. Many 
other relevant convex constraints exist, such as command and controller band- 
widths, which could also be applied if the method were extended to non-LMl 
formulations. 

3. Continue to pursue attempts to either prove convexity or find associated convex 
problems which could be used to determine a lower bound. 
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VI. CONCLUSIONS AND 
RECOMMENDATIONS 



This report has treated the subject of the application of 7Yoo control design 
and convex optimization to the design of air vehicles and their control systems. Three 
project areas defined the scope of the research effort: 

• An Tioo controller design for the F-14 autoland problem, implementing Direct 
Lift as an active control surface. 

• The programming of mixed 7Y 2 / ^oo design tools, and their application to the 
autoland controller design problem. 

• The formulation of the plant/controller optimization problem in a format where 
an upper- bound can be determined by convex methods. 

Each of these efforts were successfully completed, each with their own sets of conclu- 
sions. 

A. design example conclusions and recommenda- 
tions 

The 7-foo output-feedback synthesis methods were used to determine an au- 
toland controller for a carrier-based F-14 aircraft. Significant results of this efforts 
were: 

1. A methodology was demonstrated for the formulation of robustness analysis 
models for aeronautical applications. This methodology is appropriate for those 
problems in which the origin of the parameteric data is flight test rather than 
wind tunnels. 
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2. Direct Lift Control was successfully implemented in a MIMO design for the 
autoland problem. 

3. A methodology was demonstrated whereby SISO design specifications were 
translated in scalar weighting functions on the inputs and outputs of the syn- 
thesis model. This included tuning the controller for specified bandwidths of 
the measurement sensors. 

4. A controller was designed which did not cancel the open-loop poles of the plant. 

5. The controller performance was validated bv nonlinear simulation. 

This design example extended the methodology of previous work to the full mea- 
surement feedback problem. The methodology is recommended for consideration 
whenever control design methods are considered for use. Its principal attribute 

is that it represents a methodology by which a controls designer with limited back- 
ground in the theoretical aspects of 7 control can still apply the design tools with 
confidence. 

B. MIXED H 2 / H 0 o CONTROL CONCLUSIONS AND RECOMMEN- 
DATIONS 

The mixed H 2 / H 0 0 control phase of the research included both the coding of 
the necessary design tools for bot h the continuous and discrete time problems, as well 
as their application to a design problem similar to the F-14 autoland problem above. 
Siginifcant results included: 

1. Design tools were created which solve the continuous and discrete time mixed 
H 2 / Hog controller synthesis problems using elliptical convex optimization 
methods. 
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2. The F-14 autoland control problem was used to demonstrate a methodology 
whereby the continuous 7Y 2 / 'Hoo control design tools could be used in a MIMO 
controller synthesis problem. 

Due to the computational time required to use the mixed tools, it is recommended that 
they only be applied for design problems in which an 'H 2 specification was explicitly 
part of the design requirements. 

C. PLANT/CONTROLLER OPTIMIZATION CONCLUSIONS AND REC- 
OMMENDATIONS 

Chapter V was devoted to outlining and demonstrating a methodology whereby 
the optimization of a vehicle’s physical configuration could be posed for solution by 
the methods of convex analysis. Specifically: 

1. It was demonstrated that many typical flying qualities requirements can be 
jointly posed as Linear Matrix Inequalities, including: 

• Stabilization requirements, including pole placement, 

• Disturbance Rejection, 

• Static and Dynamic Maneuverability (Open-loop) Requirements. 

2. It was demonstrated that plant dynamics are frequently affinely dependent on 
some physical attributes of the physical configuration, such as surface size. 

3. A methodology was presented for determining an upper-bound to the plant/controller 
optimization problem. The method is appropriate for problems in which the 
design specifications can be posed as Linear Matrix Inequalities and the plant 
dynamics are affinely dependent upon plant parameters. This problem was 
shown to be quasi-convex for the optimization of single plant parameters. It 



was also shown how the method results in the determination of an upper-bound 
for the cost functions for multiple parameter problems. 

4. A methodology was outlined for accommodating modeling uncertainties into 
the plant/controller optimization problem . 

5. Multiple design examples were presented whereby joint performance require- 
ments were applied to the problem of optimizing aircraft control surface config- 
urations. 

This represents the principal major contribution of this research effort. It is recom- 
mended that the following items be pursued in this area: 

1. Commercial interior point codes should be procured when they become avail- 
able. 

2. The general methodology should be extended to other performance measures 
which have convex solutions, but which do not currently have LM1 formulations. 

3. The issue of convexity should continue to be explored, including attempts to 



identify bounding convex sets. 



APPENDIX A: ALGORITHMS FOR THE 
SOLUTION OF THE MIXED U 2 / 
CONTROLLER SYNTHESIS PROBLEMS 

This appendix presents the numerical tools which were coded to solve the mixed 
7 Y 2 / T~Loo control synthesis problem. It includes both the mathematical derivations of 
various terms, as well as verbatim listings of the final codes. Since no numerical codes 
were available to solve these problems, a considerable amount of time was devoted 
to the design of the necessary numerical routines. The optimization problems in this 
appendix were all solved by the ellipsoidal method. 

First, section A presents several simple, but perhaps obscure, relationships 
which were critical to the derivation of analytical expressions for the gradients of 
the various matrix functionals. Next, section B presents the codes associated with 
the continuous time 7 i 2 / ^Hoo problem. Section C then presents the codes associated 
with the discrete time mixed 7 i 2 / ^oo synthesis problem. Finally, section D presents 
a short discussion of the validation of the codes. 

A. FINDING THE GRADIENTS OF MATRIX FUNCTIONALS 

Both the continuous and discrete / H 2 / 7 i ^ state-feedback problems can be 
numerically solved by the straightforward application of the ellipsoidal convex op- 
timization algorithm, described in Chapter II. In both cases, the most challenging 
part was the derivation and coding of analytical expressions for the subgradients 
of 11011-differentiable functions. The following relationships are instrumental in the 
derivations of the subgradients that follow. 
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1. Derivative of an Eigenvalue of a Symmetric Matrix Functional 



Since most of the constraint functionals (and some objective functionals) 
are of the form Q(x) < 0, it is necessary to be able to determine the gradient of 
4>{x) XmaAQi*))- From [Ref. 45], given a symmetric matrix functional Q(x ) — 
Q(.r) T €R nxn operating on x eR s . and the scalar function 4>{x) := \ m ax{Q{ J’)F the 
gradient of <j!>(.r) is g, such that for each element of g: 



d<K*) x t n • i 

g% •= — t : — = u (X) — u(;r), tor all i = 1, . . . , 5 



dx 



dx t 



( A.l) 



where n(x) is the eigenvector associated with the maximum eigenvalue of Q(x ), and 
u*(.r) is its conjugate transpose. 

2. Derivative of a Matrix Inverse 

Matrix inverses occur frequently in various Riccati equations. An expres- 
sion for their derivatives is consequently required. From [Ref. 46]: 



d{X~ l X) = d(I) = 0 = d{X~ l )X + A r l dx< 



hence, 

d( X~ ] ) = -X~ l dXX~ l 

B. CONTINUOUS TIME MIXED H 2 / CONTROLLER DESIGN 

As discussed in Chapter III and [Ref. 11], the continuous mixed output-feedback 
control problem is based upon a convex expression of the state-feedback problem. It 
can be solved by the solution of the filtering Riccati equation, and the construction 
of an auxiliary plant for which a state-feedback controller is designed. This section 
consequently develops and lists the state- feedback controller design tools which can 
either be used independently or called by the output-feedback synthesis function. The 
measurement-feedback controller synthesis tools then follow. 



1 . Numerical Solution of the Continuous Time State-Feedback Prob- 
lem 

The generalized mixed continuous H .2 / 'Hex, state-feedback problem is 
posed above in Theorem 3.4 as: 

Minimize: 

fi(M(W, Y)) := fi {(C 0 Y + D 02 W)Y~\CoY + D 02 W) T } , (A.2) 

Subject to: Y > 0, and R{\V, Y) < 0, 

where 

R(W, V") := AY + YA t + B 2 W + W r Rj + B x Bj + {C X Y + D n W){C\Y + D l2 W ) T , 

(A. 3) 

and f\ is the trace, / 2 is the maximum eigenvalue, or fo is the maximum diagonal 
element. The constraint is assumed to be 7 < 1 , and w and z are assumed to 

have been scaled in order that the constraint || T Z]W ||oo< 1 is feasible. The codes 
which follow also required that 10 and z have been appropriately scaled. 

For the state- feed back problem, the controller is a constant gain matrix K 
which has been parameterized as I\ — WY~ l . Since Y = Y 7 € R nxn is symmetric, 
the problem is a search over the vector space R'\ where s = +nq. For simplicity 

and reduced computational expense, Y and W were chosen to be affine functions of x: 
F = and W = x l W l . The easiest possible mapping from x — > (l V,Y) 

was to assign each x t to a single location (or pair of locations in the case of the off- 
diagonal elements of Y). The basis matrices Y, and IF, therefore orthonormal with 
a single unit one (or pair of ones). For i = 1 to n, Y 2 had a single unit value in the 
corresponding diagonal position, and VF, = 0 . For i = n + 1 to w ^ w + ^ , each Y x had a 
pai r of symmetrical ones placed by counting down each sub-diagonal, from the first 
sub-diagonal out to the corners. For i = ^ to 71 + nq , each IT, was all zero 
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with the exception of a single one, counting down the columns from left to right. For 
this range Y t = 0. This structure is significant in that when Y t and show up in the 
gradient expressions, the multiplication was not required, but the appropriate row(s) 
or column(s) simply selected out. 

An ellipsoidal algorithm was coded in MATLAB following the method of 
Chapter II and using the following structure: 

1 . Determine if the Hoo problem is feasible, and determine a particular feasible 
controller Kp. This was done by solving the 7 i iyD synthesis equation using the 
Riccati solvers in the //-tools toolbox [Ref. 21 ]. 

2 . Determine an initial feasible solution ) p and W’ p = I\ P Y P from a solution to the 
Tioo analysis equation (3.2). 

3. Initialize the search at x — [0, . . . , 0] T , with a very large ellipsoid about x. 

4. From :r, determine Y and IF as perturbations of the particular solution (IU p , V p ). 

5. Evaluate the constraint 0 i(.r) — A mfIJ .( — V‘) < 0. If (p i(x) > 0, then use the 

eigenvector associated with the maximum eigenvalue to calculate the subgradi- 
ent: g } — . Update the ellipsoid and x and return to step 4. 

6 . Evaluate the constraint (p 2 (.r) = A max ( /?( IF, U)) < 0 . If fai?) > 0 , then use the 

eigenvector associated with the maximum eigenvalue to calculate the subgradi- 
ent: g 2 — . Update the ellipsoid and x and return to step 1 . 

7. With both constraint functionals satisfied, evaluate the objective function 0(a*) = 
f(M(W,Y)) and its subgradient: g 3 = - . Update the ellipsoid, x , and the 
upper and lower bounds on the estimate of the optimum cost. 



8. Return to step 4 unless the termination criteria is satisfied. 



9. Calculate the (sub)optimal controller K = WY '. 



10. Exit. 



Two significant computational issues were involved in actually coding the 
above routine: 1) how to test for positive definiteness; and 2) how to calculate the 
maximum eigenvalue and its corresponding eigenvector (both for the subgradients 
and the / 2 generalized cost). The first was important because both of the above 
constraint functions required a true/false assessment of the negative definiteness of 
— Y and R. Two methods were considered: Cholesky factorization, and the compu- 
tation of the maximum eigenvalue. If a Cholesky factorization of Y or —R could be 
computed, then that expression was positive definite, and the procedure could move 
on to the next step. If the factorization failed, then the maximum eigenvalue and 
its corresponding eigenvector would have to be calculated for the subgradient calcu- 
lation. The advantage of a Cholesky test, is that it is a very efficient calculation, 
which, if successful, would avoid the comparatively expensive eigen-problem for that 
step. As for the determination of the maximum eigenvalue, two choices were appar- 
ent. Clearly one choice would be to invoke MATLAB’s eig function and solve the 
whole eigen-problem. The second choice would be to use inverse iteration to isolate 
just the maximum eigenvalue and it’s vector. The eig function was chosen because 
the MATLAB implementation is native to the MATLAB core program, and takes 
advantage of symmetry for problems such as this. It was consequently faster to do 
the entire eigen-problem by eig than run a line-compiled subroutine, though the later 
required fewer flops. Similar results were encountered in choosing a method for the 
definiteness test. Though a version of h2inf syn successfully ran using a Cholesky 
test, it was no faster than the eigen test because of eig’s implementation directly in 
MATLAB. Furthermore, the Cholesky dependent variant was not as reliable when 



large problems were run. Consequently, the reader will note that eig was chosen in 
resolving both issues. These choices should be reevaluated in the event that these 
codes are translated into either FORTRAN or ‘C\ 



The gradient expressions are derived below for the each of the i — 



elements: 



9 1 . = 



d<f>i(x) 

dx, 

m dY 

-u — u 

Ox, 



= —u’YiU 



= — tr(Vjuu'). 



QM*) 

dx, 

m dR(W,Y) 

= U ~ u 

ox, 

= u-^-{AY + YA t + BAY + \\ :T Bj + B } Bf+ 
ax t 1 

(C,Y + D U W){C,Y + D u W) T }u 

= u {ay, + y,a t + b 2 if, + 1 vj bJ + 

(C, Y, + D n W,){C x Y + D u \V) T + (C,r + DiAV^CiY, + D U W,) T } 

= tr ({av; + Y,A t + BAV, + WjB%+ 

(C, v; + D X AV,){CA ' + D n W) T + ( C\ Y + D I2 JT)(C,U + D u Wi) T } 
= 2 tr ({(£,)' + D n \V) T uuC, + V',) + 

2 tr ({(CiT + D\AV) T mt ’ Du + uit m B 2 { IT,) . 



1 to n 



(A. 4) 



a?/*) 

(A. 5) 



The arrangement of these expressions is not iinicpie, but has been chosen 
deliberately to place the basis matrices IV, and V, on the outside of the argument of 
the trace. The nature of the basis matrices IV, and ) ] being all zero except a single one 



or pair of one's, meant that neither the evaluation of the trace nor the multiplication 
by \V t or Y % was required, but simply the selection of a single appropriate element out 
of the central expression. 



In the case of the objective function, the gradient will first be derived for 



f 2 (max eigenvalue). 




dXmnAMWY)) 

dxi 



m dM(W,Y ) 

U XL 




{(C 0 Y + D 02 W)Y-'{C 0 Y + D 02 W) t } u 



= «* { ( C 0 Yi + Dq 2 Wi)Y-'(C 0 Y + Do2 W ) t 
+(C 0 Y + D m W)Y-'{C 0 Y x + DnWy 
~(C 0 Y + D 02 W)Y-'Y,Y-'(C 0 Y + D 02 W) t +}u 
= tr{(Y~ l (C 0 Y + D 02 W) r u uC 0 + C^u m u(C 0 Y + D 02 W)Y~ 1 ) Y,} 

-tr {Y-'(C 0 Y + D 02 W) t uu(C 0 Y + D Q2 W)Y~'Y,} 

+tr {Y~'(C 0 Y + D 02 W) t uuD 02 W, + W? D T 02 u'u(C 0 Y + D 02 W)Y~'} . 



The gradients of f\(M(W„Y)) and fz(M(W,Y)) are then minor modifica- 



the position of the maximum diagonal element. 

2. Continuous Time State-Feedback Synthesis Codes 



h2mf forme is an administrative script that maps x into W and Y. Finally, the func- 
tions subgradlc, subgrad2c, and costgradlc calculate the subgradient vectors for 



(A. 6) 



tions [Ref. 29]. For /i, replace u*u with the identity matrix /. For /j, replace u with 
the elemental vector e{ — [0, . . . , 0, 1 , 0, . . . , 0] T , where the unit digit corresponds with 



This section lists the continuous mixed H 2 / 'H state-feedback controller 
design codes. The function h2infsyn is the principal script. The function 
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the two constraint functionals and the cost function. The coding of the subgradients 
was validated by comparison with gradient vectors which were determined by brute 

force perturbation methods (i.e. g x = • LL T J ^ where e t — [0 0, 1 , 0, . . . , 0] 7 ). 

h2infsyn 



function [K,Kp,X ,E, count ,Psil ,Psi2 .outcome, time] = . . . 

h2infsyn(f ,p ,Dim,Sf ,raitr ,exit ,Xi , Ei , count i ,Psili,Psi2i) 

7. function [K ,Kp,X ,E, count , Psil ,Psi2, outcome , time] =.. . 

7. h2inf syn(f ,p,Dim,Sf ,mitr ,exit ,Xi ,Ei , count i , Psili,Psi2i) 

7. 

7. Finds state-feedback gains for (sub)optimal mixed h2/hinf control. 

7. Solves for appropriate fi gains with which to build output feedback 
7. controller if input p is auxiliary plant. 

7. Method of evaluating generalized mixed h2/hinf cost function can be selected: 
7. f=l(trace), 2(max eigenvalue), or 3(max diag element) 

7. System matrix ’p’ must be a packed mu-tools system matrix: 

7. 

7. Dim(l) Dim(3) Dim(2) 

7. p = I AA I B1 B2 I 

7. I CO I D01 D02 I 

7* I Cl I Dll D12 I Dim(4) 

7. 

7. the columns and rows associated with the input w and the output zl 
7. must have been scaled for gamma=l 

7. mitr- max number of iterations 

7. exit- termination threshold for mixed cost, expressed as a percentage 
7. the other inputs are for restart and the code should be consulted 

7. 

7. Outputs: 

7. K- dynamic output feedback controller in packed mu-tools format 

7. Kp- central controller from Riccati methods 

7. count- Returns number of iterations for each path 

7# Psil- Upper bound on mixed cost 

7, Psi2- Lower bound on mixed cost 

7. outcome- textual result 

7 time- elapsed CPU time 

time=cputime ; 

outcome='max iterat*; 

7. unpack system matrices 
[AA , B ,C ,D] =unpck(p) ; 

nstates=Dim( 1 ) ; pdist=Dim(3) ; routput=Dim(4 ) ; sdof=Dim(S) ; 

tt=row(C); pq=Dim(2)+pdist ; 

B1=B( : , 1 : pdist ) ; B2=B( : ,pdist+l :pq) ; 

C0=C( 1 : (tt-routput ) , : ) ; C1=C( ( tt-routput +1 ) : tt , : ) ; 

D01=D( 1 : (tt-routput) , 1 : pdist ) ; 
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D11=D( (tt-routput+l) :tt , 1 rpdist) ; 

D02=D( 1 : (tt-routput ) , pdist+1 : pq) ; 

D12=D ( (tt-routput+l ) : tt , pdist+1 :pq) ; 
B1B1=B1*B1’; '/, precompute to save Hops 



'/, Determine feasibility/central controller 

ham=[AA, ( (B1*B1 ’ /0 . 998)-B2*( (D12 ’ *D12)\B2 * ) ) ; -C1’*C1, -AA *] ; 
[xl , x2 , f ail] =ric_schr(ham) ; Xinf =x2/xl ; 

if (f ail>0) 

disp( ’Statef eedback Hinf problem infeasible’), 

outcome= ’ INFEASIBLE* ; 

return 

elseif min(eig(Xinf ) )<=0, 

disp(*Hinf problem infeasible’), 

outcome= ’ INFEASIBLE* ; 

return 

end 

Kp=- (D12 ’ *D12)\B2 * *Xinf ; '/, central controller 



'/, Determine specific soln from central controller 

al=AA+B2*Kp; bl=[Bl , 1 0000* sqrt(eps)* eye (nstates)] ; cl=Cl+D12*Kp 

[xl , x2 , f ail] =ric_schr( [al * , cl * *cl ; -bl*bl ’ ,-al ] ) ; Yp=x2/xl ; 

if (fail>0) , 

outcome= ’ INDEFINITE* ; return 
elseif (min(eig(Yp) )<=0) , 

outcome= ’ INDEFINITE* ; return 
else , 

disp( ’State feedback hinf problem feasible’), 

end 

Vp=Kp*Yp; 



'/, Initialize problem or use last value? 



count= [00 0] ; 
X=zeros (sdof , 1 ) ; 
if nargin>8, 

count=counti ; 
X=Xi ; 

end 



Psil=inf; Psi2=0; 
E=1000*eye(sdof ) ; 

Psil=Psili; Psi2=Psi2i; 
E=Ei ; 



'/, begin ellipsoidal search routine 
for k=l:mitr, 

[W, Y] =h2inf formc(X ,Wp,Yp,Dim) ; */, maps X to (W,Y) 

[Vy ,Ey]=eig(-Y) ; 

[Phil , indexl] =max(diag(Ey) ) ; 

'/, Enforce Y>0 
if Phi 1>=0 , 

g=subgradlc (Vy ( : , indexl ) , nstates , sdof ) ; 

E g =E *g; gAg=sqrt(g’*Eg) ; Eg=Eg/gAg; 
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if Phil>gAg, 

outcome= ' indef inite * ; return 

end 

alpha=Phil/gAg ; count=count+ [1 0 0] ; 

*/, Enforce hinf constraint 
else , 

L1=C1*Y+D 12*W ; 
a=AA*Y+B2*W ; 

[Vinf ,Einf]=eig(a+a , +BlBl + (Ll * *Ll) ) ; 

[Phi2, index] =max(diag(Einf ) ) ; 
if Phi2>=0 , 

g=subgrad2c(V, Y, Vinf ( : , index) ,Dim, A A ,B2 , Cl ,D12 ,L1 ) ; 

Eg=E*g; gAg=sqrt (g ’ *Eg) ; Eg=Eg/gAg; 

if Phi2>gAg, 

outcome= * infeasible * ; return 

end 

alpha=Phi2/gAg ; count=count+ [0 1 0]; 

7. Given the above constraints satisfied, follow cost gradient 
else , 

[Psi ,g] =cost grade (f ,W,Y,C0,D02,Sf ,Dim) ; 

Eg=E*g; gAg=sqrt(g’*Eg) ; Eg=Eg/gAg; 

Psi2=max( [(Psi-gAg) ;Psi2] ) ; 
if Psi<Psil, 

Psil=Psi; alpha=0; 
else , 

alpha=(Psi-Psil )/gAg; 

end 

count=count+ [0 0 1]; 

7. Exit criteria 
if gAg<exit*Psil , 

disp( * Program converged to solution') 
outcome^ * converged ! * ; 
break , 

end 

end 

end 

X=X-Eg* ( ( 1+sdof *alpha)/(sdof +1 ) ) ; 

E=E-2*Eg* (Eg ' * ( ( 1+sdof *alpha)/( sdof+ 1 ) / ( 1+ alpha) ) ) ; 
E=E*((l-alpha‘2)*sdof~2/(sdof~2-l)) ; 

E= (E+E ' ) /2 ; 

end 

time=cputime-t ime; 
if outcome == * converged !* , 

K=W/Y ; 

end 



7, Following are called non-organic functions: 



7. function [W , Y , K2] =h2inf forme (X , Wp , Yp , Dim) 

7. function gl=subgradlc (vl , nstates , sdof ) 

7. function g2=subgrad2c(W,Y,v2,Dim, AA , B2,C1 ,D12) 

7. function [Psi , g] =costgradc (f , W , Y , CO , D02 , Sf , Dim) 

7. function out=pck(a,b, c ,d) from mu-tools 
7. function (a,b, c ,d)=unpck(p) from mu-tools 

7. end h2infsyn 

\{verbatim} 

\nm 

\nid \underline{h2inf forme} 

\ft 

\begin{verbatim} 

function [W , Y] =h2inf forme (X , Wp , Yp , Dim) 

7* reformats the space X in Rs to the two matrices 

7. X is assumed to be comprised of the diagonal rows of Y, starting with the 
7. main diagonal, followed by W in column order 

nstates=Dim( 1 ) ; qcontrol=Dim(2) ; pdist=Dim(3) ; sdof=Dim(5); 
j =nstates ; 

Y=Yp+diag(X( 1 instates)) ; 
for k=l :nstates-l , 
i=nstates-k ; 

Y=Y+diag(X ( j + 1 : j+i) ,k)+diag(X( j+1 : j+i) ,-k) ; 

j=j + i; 

end 

W=Wp+reshape(X( j+1 : j+nstates+qcontrol) , qcontrol , nstates ) ; 

7. end h2 inf forme 



subgradlc 



function gl= subgradlc (v .nstates , sdof ) 

7. calculates subgradient for first constraint function Y>0 

gl=zeros(sdof , 1 ) ; 
k=l ; 



for i=l instates 7. counts out diag rows 

for j = l :nstates + l-i 7. counts down diag rows 

if i==l , 

gl (k)=-v( j )*v( j ) ; 
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end 



else , 

gl (k)=-2*v( j )*v( j+i-1) ; 

end 
k=k+l ; 

end 



*/. end subgrad 1c 



subgrad2c 



function g2=subgrad2c (W , Y . v2 ,Dim, A A , B2 ,C1 ,D12 ,L1 ) ; 

*/. Uses analytical expression for subgradient 
'/, See page 16 of journal 

nstates=Dim( 1 ) ; qcontrol=Dim(2) ; sdof=Dim(5) ; 

a=v2* ( v2 * * ( AA+L1 * *C1 ) ) ; 

Sy=a+a * ; 

Sw= ( (B2 ’ +D12 1 *L1 ) *v2)*v2 * ; 
k=l ; 

g2=zeros (sdof , 1 ) ; 

for i = l instates */« counts out diag rows 

for j = l : nstates + l-i *1 counts down diag rows 

if i==l , 

g2(k)=Sy ( j , j ) ; 
else , 

g2(k)=Sy ( j , j+i-1 )+Sy( j+i-1 , j ) ; 

end 
k=k+l ; 

end 

end 

g2(k : (k+qcontrol*nstates-l ) )=2*re shape (Sw , qcontrol instates , 1 ) ; 
7. end subgrad2C 



costgradc 



function [Psi ,g3] =costgradc(f ,W,Y ,C0 ,D02 ,Sf .Dim) 

7, computes the cost function/gradient for the mixed H2/Hinf continuous time 
'/. input argument f selects which of the 3 generalized costs is to be 
*/, implemented: 

'/. 1= trace 

*/, 2= max eigenvalue 
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y. 



3= max diagonal entry 



nstates=Dim( 1 ) ; qcontrol=Dim(2) ; sdof =Dim(5) ; 

L0=C0*Y+D02*W ; 

M=LO*(Y\LO * )+Sf ; 

if f==l, 

Psi=trace(M) ; 
b=L0/Y ; 

RY=CO * *b+b ’ ♦CO-b ’ *b; 

RW=2*D02 ' *C0 ; 
else , 

if f ==2 , 

[V3 , E3] =eig(H) ; 

[Psi , index] =max(diag(E3) ) ; 
v=V3( : , index) ; 
elseif f ==3 , 

E3=diag(M) ; 

[Psi , index] =max(E3) ; 
v=zeros(length(E3) , 1) ; v( index )=1 ; 

end 

a=CO , *v; 
b=(v * *LO)/Y ; 

RY=a*b+b , *a , -b , *b; 

RW=2* (D02 ' *v) *b ; 

end 

k=l; g3=zeros (sdof , 1 ) ; 

for i=l instates */, counts out diag rows 

for j = l :nstates + l-i */, counts down diag rows 

if i==l , 

g3(k)=RY ( j , j ) ; 
else , 

g3 (k)=2*RY( j , j+i-1 ) ; 

end 
k=k+l ; 

end 

end 

g3(k : (k+qcontrol*nstates-l ) ) =reshape(RW, qcontrol*nstates , 1 ) ; 
'/. end costgradc 
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3. Continuous Mixed Ti 2 / Output-feedback Synthesis Codes 
This section lists the design code for the continuous time mixed 7 / 7-f,x 
output-feedback controller synthesis problem. The development follows exactly the 
formulae of (Ref. 11] in constructing a auxiliary plant, solving the Hoo filtering 
equation by Riccati methods. This auxiliary plant is then fed to the state-feedback 
controller synthesis code above (h2inf syn). 
h2infopfb 



function [K , Psil , count , outcome , time] =h2infopf b(f ,p ,Dim,mitr , exit) 

*/. function [K ,Psil , count , outcome , time] =h2mf opfb(f ,p ,Dim ,mitr , exit ) 

y. 

7, Finds output feedback controller for (sub)optimal mixed h2/hmf control. 

y. 



y. 

y. 

•/. 

y. 

y. 

y. 

y. 

y. 

y. 

y. 



Method of evaluating generalized mixed h2/hinf cost function can be selected: 
f=l(trace), 2(max eigenvalue), or 3(max diag element) 

System matrix , p > must be a packed mu-tools system matrix: 



Dim( 1 ) 


Dim(3) 


Dim(2) 




AA i 


B1 


B2 1 




1 CO 


1 D01 


D02 I 




1 Cl 


1 Dll 


D 12 1 


Dim(4) 


1 C2 


1 D21 


D22 1 


Dim(5 ) 



'/, mitr- max number of iterations 

'/, exit- termination threshold for mixed cost, expressed as a percentage 

y. 

'/, Outputs: 

*/, K- dynamic output feedback controller in packed mu-tools format 
*/, Psil- Upper bound on mixed cost 

*/, count- Returns number of iterations for each path 
% outcome- textual result 
'/, time- elapsed CPU time 
% 

*/. formulae are from Rotea and Khargonekar, CDC Proceedings 12/91 



*/, unpack system matrices 
[AA , B , C ,D] =unpck(p) ; 

nstates=Dim( 1) ; qcontrol=Dim(2) ; pdist=Dim(3) ; 

routput=Dim(4) ; moutput=Dim(5) ; 

noutO=row(C)-routput-moutput ; pq=Dim(2)+pdist ; 

tt=row(D)-moutput ; 

B1=B( : , 1 :pdist) ; B2=B( : ,pdist+l :pq) ; 

CO=C( 1 :noutO, : ) ; C1=C( (noutO+1) : noutO+routput , : ) ; 



C2=C( (noutO+routput+1) :row(C) , : ) ; 

D01=D( 1 : noutO , 1 :pdist) ; 

D1 1=D( (tt-routput+1) : tt , 1 rpdist) ; 

D21 =D( (noutO+routput+1 ) : row(C) , 1 : pdist ) ; 

D02=D( 1 : (tt-routput) ,pdist+l :pq) ; 

D12=D( (tt-routput+1) : tt ,pdist+l :pq) ; 

D22=D( (noutO+routput+1) :rov(C) ,pdist+l:pq) ; 

pnom=pck(AA,B,C(noutO+l :row(C) , : ) ,D(noutO+l :row(C) , : ) ) ; 

7. Designing a pure hinf controller 

disp( ’Designing a pure hinf controller to determine feasibility’) 

[Khinf ,g,gf in, Ax ,Ay] =hinf syn(pnom ,moutput ,qcontrol ,0 , 1 , .01 ) ; 
if isempty (Khinf ) , 

disp(’Hinf problem is infeasible’) 
return 

elseif gfin<=l, 

disp(’Hinf problem is feasible’) 

disp( ’Gamma value above is measure of freedom for H2 optimization’) 

end 

7. Solve the filtering equation 
C2t ilde=sqrtm(D21*D21 ’ )\C2; 

ham= [AA ’ (Cl , *C1-C2tilde ’ *C2tilde) ; -B1+B1 ’ -AA] ; 

[ql ,q2,f ail, eig_min] =ric_schr (ham) ; 
if fail>0, 

error ( ’filtering equation troubles’) 

end 

Q=q2/ql; Q=Q+Q’/2; 
if min(abs (eig(Q) ) )<-le-l0, 

error(*Q is not positive definite’) 

end 

*/, build the auxiliary plant 
AAa=AA+Q*Cl ’ *C1 ; 

Bla=Q*C2tilde ’ ; 

B2a=B2+Q*Cl ’ *D12 ; 

D01=zeros(row(D01) ,moutput) ; 

Dll=zeros(routput ,moutput) ; 

paux=pck(AAa, [Bla,B2a] , [CO; Cl] , [D01 , D02 ;D11 , D12] ) ; 

Sf =C0*Q*C0 ’ ; 

Dima=[Dim(l) ,col(B2a) ,col(Bla) ,row(D01) ,nstates* (nstates+1 )/2+nstates*col(B2a)] 

7. Design a state-feedback mixed controller for the auxiliary plant 

[Kip , Kp , X , E , count , Psi 1 , Psi2 , outcome , time] = h2inf syn(f , paux ,Dima , Sf , mitr , exit ) ; 

7* Build the dynamic controller 

K=pck( (AAa-Bla*C2tilde+B2a*Klp) ,Bla, Kip, zeros (qcontrol ,moutput ) ) ; 
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*/. end h2infopfb 



C. DISCRETE TIME MIXED H 2 / H*. CONTROLLER SYNTHESIS 

As discussed in Chapter III and [Ref. 12], the mixed output-feedback control 
problem is based upon a convex expression of the full-information problem. It can 
be solved by the solution of a filtering Riccati equation, and the construction of an 
auxiliary plant for which a full-information controller is designed. This section con- 
sequently develops and lists the state-feedback controller synthesis tools which could 
either be used independently, or called by the output-feedback synthesis function. 
Furthermore, in the absence of commercial synthesis tools for discrete time, a 

measurement-feedback code was written, based on Riccati methods. It was helpful 
both for assessing the feasibility of example problems, and also formed the structural 
basis for the mixed / 7"foo synthesis routine. This section consequently concludes 
with listings of both the discrete and 7i 2 / H<x, synthesis codes for measurement 

feedback controllers. 

1. Numerical Solution of the Discrete Time Full-Information Prob- 
lem 

This section outlines the development of the ellipsoidal design codes for the 
discrete mixed ?-f 2 / 7ioo full-information controller synthesis problem. Recall from 
Theorem 3.5 that the problem can be expressed as a convex optimization problem: 
Minimize: 

l\i)) : = 

/, {(CoY + Do 2 \V)Y-'(C 0 Y + DoiWf + (A.I + A> 2 A' 2 )( An + D 02 K 2 ) t } , 

(A.7) 



U9 



Subject to: Y > 0, and L ( IV', V, I\ 2) < 0, 



when 



L(W,Y,K 2) : = 

AY + B 2 W 
C X Y + D n W 



)' 



-i 



AY + B 2 W 
C\Y + D n W 





$1 + B 2 I \ 2 


R i T /? 2 A 2 


T 


’ Y 0 ' 


+ 


D\y + B \ 2 A 2 


D u + D u h 2 




0 I 



(A.8) 

and /i is the trace, / 2 is the maximum eigenvalue, or / 3 is the maximum diagonal 
element. 

The structure of the code is very similar to the continuous codes above. 
Two items are of significance which warrant independent discussion. First of all, the 
structure of the controller is different for the discrete problem, in that it is now a full- 
information feedback gain matrix, rather than state-feedback. The parameterization 
of the controller is now I\ j t = [WY'~ ] A 2], necessitating that the search has an 
additional p X q degrees of freedom, where p := dim (w) and q := dim (u). A set of 
basis matrices A 2 , £ R 9Xp was consequently constructed with identical structure as 
the set of W, above. The second, and more challenging issue was the determination 
of an initial feasible controller. This was necessary in order to assess the feasibility 
of the problem and to give the iterative ellipsoidal search a good starting point. To 
this date, no commercial codes are available to solve the discrete time Riccati 

equations, and so considerable effort was devoted to cleanly solving these problems. 
The codes for these problems are included here as subroutines to the main script. 

1. Determine if the Tioo problem is feasible, and determine a particular feasible 
controller A p = [A' lp A' 2 ]. This was done by solving the discrete time Hoo 
synthesis equation [Ref. 31]. 
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2. Determine Y p and \V P = I\ P Y P from the 'H^, analysis equation (3.2). 

3. Initialize the search at x = [0, . . . , 0] 7 , with a very large ellipsoid about a\ 

4. From#, determine Y, W , and I\ 2 as perturbations of the particular solution 
{W p ,Y p J< 2p ). 

5. Evaluate the constraint <f)\(x) = A mar ( — V) < 0. If <p\{x) > 0, then use the 
eigenvector associated with the maximum eigenvalue to calculate the subgradi- 
ent: g\ = d ^ . Update the ellipsoid and x and return to step 4. 

6. Evaluate the constraint — A mai .(L( \\\ V', A 2)) < 0. If foix) > 0, then 

use the eigenvector associated with the maximum eigenvalue to calculate the 
subgradient: g 2 = ( - ^ T ‘ ♦ Update the ellipsoid and x and return to step 4. 

7. With both constraint functionals satisfied, evaluate the objective function il'{x) = 

f(\V,}\I\ 2 )) and its subgradient: g 3 = . Update the ellipsoid, x, and the 

upper and lower bounds on the estimate of the opt imum cost . 

8. Return to step 4 unless the termination criteria is satisfied. 

9. Calculate the (sub)optimal controller l\ = [II V -1 I\ 2 }. 

10. Exit. 

The discussion above in section 13, regarding computational issues, is also 
germane to these codes. 

The analytical expressions for the subgradient expressions are derived be- 
low. Recall that u is the eigenvector associated with the maximum eigenvalue. The 
first subgradient g\ is omitted since it is identical to the continuous time problem. 
Due to the structure of L[W,Y,K 2), it is easiest to break the gradient expression for 



151 



g 2 into its respective parts. Additionally, the replacement A', = WY 1 is made when 
convenient. 



9 2. = 



For i = 1 to w ^” 2 +1 ^ + nq, A 2 , = 0: 

d(f> 2 (x) 



dii 

.dL(W,Y,h'2) 

u u 



dx x 



= u 



_d_ 

dx, 



AY + B 2 W 
CiY + DuW 



Y 






AY + B 2 W 
C\Y + D U W 



+ - 



Y 0 
0 I 



u .{ 


' A 


b 2 ‘ 


Yi 


r-’ 




l 




D\ 2 


Wi 


c’,r + d 12 vf 



1 T 



+ 



AY + B 2 W 
CiY + D n W 

AY + B 2 W 
C,Y+D U W 



' Yi ‘ 


T 


A 


#2 ‘ 


11/ 






D\ 2 



Y~' 
i-'iiV - 1 



= 2 tr 



-tr 





A T B 2 A j 


T 

* 


'a b 2 ' 


■ 


j 


. C-, + D\ 2 K\ 


?/u 


(\ D n 


. 


[ 


A + /?2 1\\ 
C \ 4- D\ 2 I\ i 


T 

HU* 


/I Z?2 A j 
^’i + A^i2 A i 



AY + B 2 W 
C, Y + D n W 



Y, 

Wi 

T 



1 T 



Yi 0 
0 0 



Y — uv“ 



Y 0 
0 0 



For i = n ^ n 2 + 1 ^ + nq + 1 to -p ) ] — Q and = 0: 

d<t> 2 {x) 



92, - 



dx t 

m dL(W,YJ<2) 

u u 



dx t 



= u 



= u 



d_ 

dx i 



B\ + B 2 I\ 2 
D\ i + D\ 2 1\ 2 



B\ + B 2 I\ 2 
+ B\ 2 I\ 2 



#2 

B\ 2 



K 



2 , 



B\ 4- B 2 A 2 
^ 1 ! + B\2 f\ 2 



+ 



B\ + B 2 I\ 2 
Dw + D\ 2 I\ 2 






u 



•(A. 9) 



D 12 



u 



= 2tr 



/A + fl 2 A'a 
/A i 4- D\ 2 I\ 2 



t T 



UV 



B 2 

Du 



A 



2, 



(A. 10) 



The subgradient for the cost functional will first be derived for f 2 , and then 



modified as above: 



03, = 



d<f>-j{x) 

dx, 

.dM(W,Y,I<2) 

u u 

ax t 



= u— {(C 0 Y + D 02 W)Y-'(C 0 Y + D 02 W ) 1 



+ (A)1 + Dq 2 I\ 2 ){Dq\ + Dq 2 I\ 2 ) T } 



— u‘ < [Co C 02 ] 



Yi 

w. 



(Co + D m h\ ) T + (Co + D 02 I\ l )[Y, Ilf] 
~ u {(Co + Y)q 2 I\ 1 ) V^(Co -F Dq 2 I\ i ) 7 1 1 / 
u‘ {+Dq 2 I\ 2i (Do\ + Dq 2 J\ 2 ) 7 + (An + Dq 2 I\ 2 ) A^/)q 2 } 11 



— 2 tr < (Co + Dq 2 I\ 1 f uu [Co Cl 



02 J 



v; 

IK 



+tr {(Co + Dq 2 1\ ] Y iiu’(C 0 + Dq 2 I\ 1 )J 
+2 tr {(An + Dq 2 1\ 2 ) 7 uv Dq 2 I\ 2> j . 



C 0 7 ’ 

^2 



(A. 11) 



The gradients of /i(VK, T, I\ 2 )) and / 3 (U', )\ I\ 2 ) are then minor modifications [Ref. 
29]. For /], replace ii’a with the identity matrix /. For / 3 , replace u with the 
elemental vector e, = [0, . . . , 0, 1, 0. . . . , 0] T , where the unit digit corresponds with the 
position of the maximum diagonal element. 

2. Discrete Time H 2 / Fiill-Information Controller Synthesis Codes 
This section lists the discrete mixed Ti. 2 / 'H. OCl state-feedback controller 
design codes. The function dh2infsynl is the principal script. The function 
h2 inf form is an administrative script that maps the vector .r into W, Y, and I\ 2 . 
The functions df iric2 and dhinfric solve the discrete synthesis and analysis 

Riccati equations. Pinally, the functions subgradl, subgrad2, and costgradlc cal- 
culate the subgradient vectors for the two constraint functionals and the cost function. 
Note that subgradl is identical to its continuous time counterpart and is included 
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here simply for completeness. The coding of t he subgradients was t he difficult part of 
the development, and the codes were validated (and the multiple errors corrected) by 
comparison with gradient vectors which were determined by brute force perturbation 
methods (i.e., g x — where e, = [0, . . . , 0, 1, 0, . . . , 0] T ). 

dh2infsynl 



function [K ,Kp,X ,E, count , Psil , Psi2, out come, time] =. . . 

dh2inf synl (f ,pd ,Dim,Sf ,mitr , exit , Xi , Ei , count i , Psili f Psi2i) 

*/. function [K ,Kp, X , E , count ,Psil ,Psil2 , outcome , time] = . 

*/, dh2inf synl (f ,pd, Dim, Sf ,mitr , exit , Xi , Ei , count i , Psili , Psi2i) 

y. 

*/, Finds full information feedback gains for DISCRETE (sub)optimal mixed h2/hinf 
'/, control. Solves for appropriate fi gains with which to build output feedback 
'/, controller if input ’pd' is auxiliary plant. 

*/, Hinf constraint is applied as infnorm(Tzlw)<l . Different values of gamma 
*/, must be absorbed into the appropriate rows of the plant matrix. 

y. 

'/. Inputs: 

'/, Method of evaluating generalized mixed h2/hinf cost function can be selected: 
'/, f=l(trace), 2(max eigenvalue), or 3(max diag element) 

’/, System matrix 'pd' must be a packed mu-tools system matrix, with the noted 



dimensions : 










Dim(l) 


Dim(3) 


Dim(2) 




1 AA 


1 B1 


B2 I 


pd= 


1 CO 


1 D01 


D02 1 




1 Cl 


1 Dll 


D12 1 Dim(4) 



y. 

*/, Note: the columns and rows associated with the input w and the output zl 

*/, must have been scaled for gamma=l 

'/, ’Dim* holds the descriptions of the problem size: 

*/, Dim(5)=sdof=Dim(l)*(Dim(l)+l)/2 + Dim(2) * (Dim( 1 ) +Dim(2) ) 

*/, * Sf * is the filtering cost matrix for the output feedback problem and 

*/, should be set to zeros(nstates) for full info feedback problem 
'/, ’mitr’ is the max number of iterations 
*/, ’exit’ is the exit criteria as fraction of the cost 

*/, The remaining input variables are for restarting a problem that had not yet 
*/, reached convergence and should be empty for initialization. 

y. 

*/, The outputs are the gain matrix K = [K1,K2], the central controller Kp, and the 
'/, stopping parametrics which provide for restart capability if the problem had 
*/, not yet converged, 'outcome* identifies the termination branch followed. 

% 

'/, Constraints are applied using the formulation of Thm 4.3 from Kaminer, 

*/, Khargonekar and Rotea. This is the TWO STEP contraint. 

y. 



*/* This version uses MATLAB’s ’eig* to evaluate positive definiteness 

%t ime=cput ime ; 
outcome='max iterat * ; 

'/♦ unpack system matrices 
[AA , B > C , D] =unpck(pd) ; 
sdof=Dim(5); nstates=Dim( 1 ) ; 

pdist=Dim(3) ; routput=Dim(4) ; tt=row(C) ; pq=Dim(2 ) +pdist ; 

B1=B( : ,1 rpdist) ; B2=B( : , pdist+1 :pq) ; 

C0=C(1 : (tt-routput) , : ) ; C1=C( (tt-routput+1) :tt , : ) ; 

D01=D( 1 : (tt-routput) , 1 rpdist) ; 

D1 1=D( (tt-routput+1) : tt , 1 rpdist ) ; 

D02=D ( 1 r (tt-routput) ,pdist+l :pq) ; 

D12=D( (tt-routput+1) : tt ,pdist+l rpq) ; 

'/, Determine feasibility and specific solution (central controller) 

'/. Solve the synthesis Riccati equation 

[Klp,K2p,P,Perr , erf lg]=dfiric2( AA,B1 ,B2, Cl, Dll ,012,0.99) ; 

if erflg>l, 

outcome 3 * INFEASIBL1 * ; return 

end 

Kp= [Kip , K2p] ; 

'/. Solve the analysis equation 

[Yp , erf lg] =dhinf ric ( (AA+B2*Klp) 1 , (Cl+D12*Klp) 1 , (Bl+B2*K2p) 1 , (D1 l+D12*K2p) * ,0.99) ; 
if erflg>0, 

outcome 3 * INFEASIBL2 * ; return 



X Initialize problem or use last value? 

X This is a weak point in the code right now as it initializes the ellipsoid 
X as something arbitrarily huge. Need to find a way to initialize the ellipsoid 
X in a smarter way. 



end 



Wp=Klp*Yp; 



count 3 [000]; 
X=zeros ( sdof , 1 ) ; 
if nargin>6, 



Psil=inf ; 
E=100*eye( sdof ) ; 



Psi2=0; thresh=0; 



count=counti ; 
X=Xi ; 



Psil=Psili; Psi2=Psi2i; 

E=Ei ; 



elseif nargm<6, 



error ( 1 insufficient number of input arguements') 

end 



Z=zeros (nstates , routput ) ; 



gam=l; 



for k=l rmitr , 

[W , Y , K2] =h2inf f orra(X , Wp , Yp , K2p , Dim) ; X maps X to (V,Y,K2) 



X Enforce Y>0 
[Vy , Ey] =eig(-Y) ; 

[Phil , index 1] =max(diag(Ey ) ) ; 



if Phil>0, 

g=subgradlc(Vy ( : , index 1) , nstates , sdof ) ; 

Eg=E*g; gAg=sqrt(g’*Eg) ; Eg=Eg/gAg; 

if Phil>gAg, 

outcome^ ' indef inite ' ; return 

end 

alpha=Phil/gAg; 
count=count+ [l 0 0]; 

'/, Enforce infinity norm constraint 
else , 

K1=W/Y ; 

a=[AA+B2*Kl;Cl+D12*Kl] ; 
b= [B1+B2*K2;D11+D12*K2] ; 

[Y,2;2' , eye (rout put )] ; 

[Vinf ,Einf] =eig(L) ; [Phi2 , index] =max(diag(Einf ) ) ; 

if Phi2>thresh, 

g=subgrad2(Kl ,K2, Vinf ( : , index) ,Dim , A A , B2 , Cl ,D12,a,b) ; 
Eg=E+g; gAg-sqrt (g 1 *Eg) ; Eg=Eg/gAg; 

if Phi2>gAg, 

outcome = * inf easible * ; return 

end 

alpha=Phi2/gAg; 
count=count+ [0 1 0]; 

*/, Given above are satisfied, follow cost gradient 
else , 

[Psi ,g] =costgrad(f , Y ,K1 ,K2,C0,D01 ,D02,Dim,Sf ) ; 

Eg=E*g; gAg=sqrt(g’*Eg) ; Eg=Eg/gAg; 

Psi2=max( [(Psi-gAg) ;Psi2] ) ; 
if Psi<Psil, 

Psil=Psi; alpha=0; 
else 

alpha=(Psi-Psil)/gAg; 

end 

count = count+ [0 0 1]; 

*/. Exit criteria 
if gAg<exit*Psil , 

disp( Program converged to solution 1 ) 
outcome = * converged ! 1 ; break 

end 

end 

end 

X=X-Eg* ( (1+sdof ♦alpha) /(sdof +1 ) ) ; 

E=E-2*Eg* (Eg 1 ♦( ( 1 + sdof ♦alpha)/(sdof +1 ) /( 1+alpha) ) ) ; 

E=E*( ( l-alpha~2) ♦sdof" 2/( sdof ~2-l )) ; 

E=(E+E 0/2; */, enforce symmetry 

end 

'/«time=cput ime-t ime ; 
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converged ! * , 



if outcome == * 

K=[K1 K2] ; 

end 

'/. Following are called non-organic functions: 

*/. f unct ion [W , Y , K2] =h2inff orm( X , Wp , Yp , K2p, Dim) 

'/. function gl=subgradl ( vl ,nstates , sdof ) 

'/. function g=subgrad2(Kl ,K2 , Vinf ( : , index) , Dim, A A , B2 , Cl ,D12 , a , b) ; 

'/. function [Psi ,g] =costgrad(f , Y,K1 ,K2 , CO ,D01 ,D02,Dim,Sf) ; 

*/. function Sys=pck(a ,b, c ,d) from mu-tools toolbox 

*/. function [FI ,F2,P,Perror,erflg]=dfiric2(A,Bl , B2,C,D11 ,D12,gam) ; 

'/. function [Yp , erflg] =dhinfric(F , G ,H, J ,gam) ; 

'/. end dh2infsynl 



dfiric2 



function [FI , F2 ,P , Perror , erf lg] =df inc2(A ,B1 , B2 , C ,D1 1 ,D12 ,gam) ; 

'/. [FI , F2 , P , Perr , erflg] = DFIRIC2(A,B1 ,B2,C,D11 ,D12,gam) ; 

V. 

'/. This routine solves the Discrete Algebraic Riccati equation 
'/, for the full information h-infinity problem: 

*/, Find a P such that: 

'/. V(P) = B2*PB2+D11 'Dll > 0 

*/, R(P)=gajiT2*I-Dll ’Dll-Bl *PB1+(B1 ’PB2+D11 *D12) *inv(V(P) )*(B1 ’PB2+D11 >D12) *>0 

’/. 

*/, and the DARE: P = A’PA + C*C - Xb*inv(G(P) )*Xb » 

'/. 

*/, is satisfied with: 

7. G(P) = [ Dll’Dll + Bl’PBl- gajiT2I D11*D12 + B1*PB2 ; 

7, 012*011 + B2*PB1 D12 *D12 + B2*PB2 ] 

•/, Xb = A *P [B1 B2]+C*[D11 D12] ; 

•/, 

*/, where u(k) = [FI , F2] * [x(k) * w(k) *] * the solution to the full information 
'/, case. The solution is based on Iglesias* symplectic pencil formulation. 

'/, WARNING: The input argument order is different from Stoorvogel * s 1 df iric * to 
'/, make the formulation consistent with Rotea and Kaminer’s notation. 

y. 

*/, The following inorganic matlab functions are called: 

'/. abcdchk2 

y. begin dfiric2 

erf lg=0 ; 



*/, CHECK THE CONSISTENCY OF THE MODEL MATCHING PROBLEM 

[ml ,n ,p,msgl] =abcdchk2(A , B1 ,C,D11) ; 



[m2 , n , p ,msg2] =abcdchk2( A , B2 ,C ,D12) ; 

if ~ ( isempty (msgl ) ft isempty (msg2) ) , 
disp( 'ERROR IN THE REALIZATION * ) ; 
disp(msgl) f disp(msg2) 
erf lg=2 ; 
return ; 
end 

Ip=eye (ml ) ; Ir=eye(p); In=eye(n); 

Zn=zeros (n) ; 

Rl = inv( [Dll ' *D1 1-Ip*gam~2 , D11 , *D12; D12'*D11, D12'*D12]); 
'/, symplectic pencil for DARE: 

SINF1= [ A- [B1 B2]*R1*[D11 D12] »*C f Zn 

-C * * (Ir- [D1 1 D12] *R1* [Dll D12]')*C, In ]; 

SINF2= [ In , [B1 B2]*R1*[B1 B2] 1 

Zn , (A-[B1 B2]*R1*[D11 D12D »*C) ; 

[Vs ,Ts] =eig(SINFl , SINF2) ; 

Ts=diag(Ts ) ; 

if min(abs(log(abs(Ts) ) ) )<( 10000* eps) , 

disp( ’Hamiltonian is not in dom(Ric)'), 
erf lg=3 ; 
return 
else , 

indexl=f ind(abs(Ts)<l) ; 

P=Vs(n+l :2*n, index 1) /Vs (1 :n, index 1) ; 

P=real (P) ; 

P=(P+P , )/2; X Ensures P=P' 

end 



7. Verify accuracy of solution 
GP=inv(inv(Rl) + [Bl B2] , *P*[B1 B2] ) ; 

Xb=A * *P* [B1 B2]+C’*[DU D12] ; 

Perror= A’*P*A - P + C’*C - Xb*GP*Xb'; 

accuracy=(norm(Perror)/norm(P) ) ; 
if accuracy>le-6 , 

disp(* Warning: Solution to DARE may be inaccurate *) ; 

accuracy 

erf lg=l ; 

end 



7. Check for stability 
Acloseloop=A-[Bl B2]*GP*Xb>; 
if max(abs (eig(Acloseloop) ) )>=1 , 

disp('Closed loop system not stable*) 
erf lg=4 ; 



return 



end 

VPi = pinv(B2 , *P*B2+D12 , *Dl2) ; 
FI = -VPi* (B2 ’ *P*A+D12 ’ *C) ; 

F2 = -VPi*(B2’*P*Bl+D12’*Dll) ; 
return 

end dfiric2 



dliinfric 



function [Y , erf lg] =dhinf ric(F , G , H , J ,gam) ; 

*/• [Y , erf lg] =dhinf ric(F ,G , H , J,gam) ; 

7 . 

*/, This routine solves the Hinf Discrete Algebraic Riccati equation for a closed 
'/♦ loop system F,G,H,J. 

y. 

*/* Find a Y such that: 

*/. R = gam~2*I - J’*J - G»*Y*G > 0 

*/. FYF * - Y + GG * + (FYH > + GJ , )^R\(HYF > + JG’) = 0 

y. 

y. The solution is based on Iglesias’ symplectic pencil formulation (eqn 2.6) 

*/. Calls chol2 and row from ktools 

[n m] =size(G) ; 

R=gam~2*eye (m)- J 1 * J ; F=F+G*(R\J ’ )*H; 

*/, form Symplectic pencil 

S1=[F zeros(n,n); -H * *inv(eye(row( J ) )-J* J * )*H eye(n)] ; 

S2= [eye (n) -G*(R\G'); zeros(n.n) F •] ; 

[Vs ,Ts] =eig(Sl ,S2) ; Ts=diag(Ts) ; index l=f ind(abs(Ts)<l ) ; 

if min(abs(log(abs(Ts) ) ) )<( 10000* eps) , 
erflg=l ; return 

end 

Y=real(Vs(n+l :2*n, indexl )/Vs ( 1 :n, index 1 ) ) ; Y=(Y+Y’)/2; 

if (chol2( Y,n) ~=1 ) I (chol2( (R-G * *Y*G) ,m)“=l ) , 
erflg=l; return 

end 

erf lg=0 ; 

'/, end dhinfnc 



h2infTonn 



function [W, Y , K2] =h2inf form(X ,Wp,Yp,Khinf 2, Dim) 

7. reformats the space X in Rs to the three matrices 

7. X is assumed to be comprised of the diagonal rows of Y, starting with the 
7, main diagonal, followed by W in column order, and lastly by K2 by column 

nstates=Dim( 1 ) ; qcontrol=Dim(2) ; pdist=Dim(3) ; sdof=Dim(5 ) ; 

j=nstates ; 

Y=Yp+diag(X( 1 instates) ) ; 
for k=l : nstates-1 , 
i=nstates-k ; 

Y=Y+diag(X( j + 1: j + i) ,k)+diag(X( j + 1 : j + i) ,-k) ; 

end 

W=Wp+reshape(X( j+1 : j+nstates+qcontrol) , qcontrol , nstates ) ; 

K2=Khinf 2+reshape(X( j+nstates*qcontrol+l : sdof ) , qcontrol ,pdist) ; 

7. end h2 inf form 



subgrad 1 



function gl= subgrad 1 (v , nstates , sdof ) 

7. calculates subgradient for first constraint function Y>0 

gl=zeros (sdof , 1 ) ; 
k=l ; 

for i=l instates 7. counts out diag rows 

for j = l :nstates + l-i 7. counts down diag rows 

if i==l, 

gl(k)=-v(j)*v(j) ; 
else , 

gl(k)=-2*v(j)*v(j+i-l); 

end 

k=k+l ; 

end 

end 

7. end subgrad 1 



subgrad‘2 



function g2=subgrad2(Kl ,K2,v2,Dim, AA,B2,C1 ,D12,a,b) ; 
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'/. Uses analytical expression for subgradient 
'/♦ See page 16 of journal 

nstates=Dim( 1 ) ; qcontrol=Dim(2) ; pdist=Dim(3) ; sdof=Dira(5) ; 
ab=a> *v2 ; 

ac=ab* (v2 1 * [A A ; Cl] ) ; 
bd=(v2'*[B2;D12] ) ; 

Sy=ac + ac 1 -ab*ab * ; 

Sw=ab*bd ; 

Sk=(b’*v2)*bd; 

k= 1 ; 

g2=zeros (sdof , 1 ) ; 

for i=l:nstates */, counts out diag rows 

for j = l :nstates + l-i '/. counts down diag rows 

if i==l, 

g 2(k)=Sy(j,j)-v2(k)~2; 
else , 

g2(k)=Sy(j ,j+i-l)+Sy(j+i-l , j )-2*v2(j ) *v2( j + i-1 ) ; 

end 

k=k+ 1 ; 

end 

end 

g2(k: (k+qcontrol*nstates-l ) ) =2* reshape (Sw , qcontrol instates , 1 ) ; 
g2( (k+qcontrol instates) : sdof ) =2*reshape(Sk, qcontrol* pdist , 1 ) ; 

'/, end subgrad2 



costgrad 



function [Psi3 , g3] =costgrad(f , Y,K1 , K2 f C0,D01 , D02 , Dim , Sf ) 

'/, function [Psi3,g3]=costgrad(f , Y,K1 ,K2,C0,D01 ,D02,Dim,Sf ) 

V. 

'L FOR USE WITH DH2INFSYN 

*/, computes the cost function for the mixed H2/Hinf discrete time 
'/« input argument f selects which of the 3 generalized costs is to be 
'/, implemented: 

'/. 1= trace 

*/« 2= max eigenvalue 

'/, 3= max diagonal entry 

'/, also determines the subgradient for the cost 

V. 

'/. calls row (ktools) 

sdof=Dim(5) ; nstates=Dim( 1 ) ; qcontrol=Dim(2) ; pdist=Dim(3) ; 
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dkl=D02*Kl ; 
a=CO+dkl ; 
b=D01+D02*K2 ; 

M=a*Y*a , +b*b , +Sl ; 
if f==l, 

Psi3=trace(M) ; 

RY=CO , *CO-dkl , *dkl; 

RW=2*D02 1 *a ; 

RK2=2*D02'*b; 
else , 

if f ==2 , 

[V3 ,E3] =eig(M) ; 

[Psi3 , index] =max(diag(E3) ) ; v=V3( : , index) ; 

elseif f ==3 , 

[Psi3, index] =max(diag(M) ) ; v=zeros (row(M) ,1); 

else , 

error (* fir st input argument must be 1,2, or 3') 

end 

a=CO * *v ; 
d=D02 * *v ; 
dkl=d * *K1 ; 

RK2=2*d* (v 1 *D01+d * *K2) ; 

RY=a*a , -dkl , *dkl; 

RW=2*d*(a'+dkl) ; 

end 



k=l ; g3=zeros (sdof , 1 ) ; 

for i=l instates */. counts out diag rows 

for j=l :nstates+l-i */, counts down diag rows 

if i==l, 

g3(k) =RY( j , j ) ; 
else , 

g3(k)=2*RY ( j , j+i-l) ; 

end 

k=k+l ; 

end 

end 

g3(k : (k+qcontrol*nstates-l ) ) =reshape(RW , qcontrol+nstates , 1 
g3( (k+qcontrol*nstates) : sdof )=reshape(RK2 , qcontrol*pdist , 1 

7, end costgrad 



v(index) 



); 

); 
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3. Discrete Hoo Output-Feedback Controller Synthesis Problem 

The following design code was prepared to solve the discrete Hoc, output- 
feedback controller synthesis problem. In the absence of commercial codes to solve 
this problem, this code was useful to assess the feasibility of synthesis models prior 
to attempting the mixed 7Y 2 / H 0 o problem. Specifically, the value of achievable 
7 for the Hoo controller was a measure of the degree of freedom available to the 
H 2 optimization. The Hoo problem is solved by solution of the filtering equation by 
Iglesias 1 symplectic pencil method [Ref. 47], and then construction of an auxiliary 
plant per Stoorvogel [Ref. 31]. 



dhinfsyn 



function [k ,gf in] =dhinf syn(pd , qcontrol ,moutput , logam , higam , tol) 
function [k , gf in] =dhinf syn (pd , qcontrol , moutput , logam , higam , t ol ) 



Determines discrete time controller which minimizes the infinity 
norm of w to z (to within the specified tolerance). 

The discrete system P is partitioned (per mu-tools): 

la bl b2 I 

p I cl dll dl2 I 

I c2 d21 d22 I 

where b2 has column size of the number of control inputs (qcontrol) 
and c2 has row size of the number of measurements (moutput) being 
provided to the controller. 



'/, dhinfsyn calls dfiric2, row, col (personal codes) and unpck from mu-tools 
'/, toolbox 



[AA , BB , CC , DD] =unpck (pd) ; 
nzl=row(CC) -moutput ; 

B1=BB( : , 1 : nwl ) ; 

C1=CC( 1 :nzl , :); 

D11=DD(1 :nzl , 1 :nwl) ; 

D21=DD( 1+nzl :row(CC) , 1 :nwl ) ; 



nwl=col(BB)-qcontrol ; 

B2=BB ( : ,nwl+l : col(BB) ) ; 

C2=CC(nzl+l : row(CC) , : ) ; 

D12=DD( 1 :nzl ,nwl+l : col(BB) ) ; 

D22=DD ( 1+nzl : row(CC) ,nwl+l : col(BB) ) ; 



garni =higam ; gam2= logam ; gam=gaml; 

Ia=eye(Dll^DU >)-Dll*Dll } ; 

while (gaml-gam2)/gaml>tol , 
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'/, solve the filtering equation 

[LI ,L2 ,q , Qerror , erflgl] =df iric2(AA* , Cl » , C2 ’ , B1 » ,D1 1 ’ ,D21 1 ,gam) ; 
if erflgl<=l, 

'/, Build Gfi(Q), the augmented plant 
V=C2*Q*C2 * +D21*D21 * ; 

R=Ia-Cl*q*Cl 1 +Cl*q*C2 » * (V\C2*q*Cl * ) ; 

Z=AA*q*Cl , +Bl*Dll , -(AA*q*C2 , +Bl*D21 ’ )* (V\(C2*q*Cl »+D21*Dll * ) ) ; 

Vhalf=inv(sqrtm(V)) ; 

Rhalf=inv(sqrtm(R)) ; 

AAq=AA+Z* (R\C 1 ) ; 

Blq= ( AA*q*C2 * +B1*D21 >+Z* (R\(Cl*q*C2 * +D1 1*D21 1 ) ) ) *Vhalf ; 
B2q=B2+Z*(R\D12); 

Clq=Rhalf *C1 ; 

Dllq=Rhalf*(Cl*q*C2 , +Dll*D21 »)*Vhalf ; 

D12q=Rhalf *D12 ; 

'/, Now solve for the full-info gains which satisfy the hinf prob 
[Kla ,K2a,P , Perror , erflg2] =df iric2( AAq , Blq, B2q,Clq,Dllq,D12q,gam) ; 
if erf lg2<= 1 , 
gaml=gam ; 

gam=(gam+gam2)/2 ; disp(gam) 

end 

end 

if max( [erf lgl ; erf lg2] )>=1 , 
if gam==higam , 

error ( problem not feasible within specified gamma range') 

end 

gam2=gam; 

gam=(gam+gaml )/2; disp(gam) 
else , 

Kl=Kla; K2=K2a; 

end 

end 



'/, Build hinf controller 
Ac=AAq+B2q*Kl- (Blq+B2q*K2)*Vhalf *C2 ; 
Bc=(Blq+B2q*K2)*Vhalf ; 

Cc=Kl-K2*Vhalf *C2 ; 

Dc=K2*Vhalf ; 
k=pck(Ac , Be ,Cc ,Dc) ; 
gf in=gaml; 

*/, end dhinfsyn 
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4. Discrete 7^2 / 'Hoo Output-Feedback Controller 



The following function file solves the discrete 7i 2 / 'H™ output-feedback 
controller synthesis problem. It is based upon the optimal discrete 7i^, code above 
and differs principally in that after the auxiliary plant is constructed it calls the 
dh2infsyn to solve the mixed full-information state-feedback controller problem. As 
with the continuous codes, w and r are assumed to have been scaled in order that 
the constraint || T Z}W ||oo< 1 is feasible. 



dh2infsyn 



function [K, count ,Psil ,Psi2 .outcome , time] =dh2infopfb(f .pd.Dim.mitr .exit) 



7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7 . 

7 . 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 

7. 



Finds full information feedback gains for DISCRETE (sub)optimal mixed h2/hinf 
control. Solves for appropriate fi gains with which to build output feedback 
controller if input ’pd’ is auxiliary plant. 

Hinf constraint is applied as infnorm(Tzlw) <1 . Different values of gamma 
must be absorbed into the appropriate rows of the plant matrix. 

Inputs : 

Method of evaluating generalized mixed h2/hinf cost function can be selected: 
f=l(trace), 2(max eigenvalue), or 3(max diag element) 

System matrix ’pd’ must be a packed mu-tools system matrix, with the noted 
dimensions : 



Dim( 1 ) 


Dim(3) 


Dim(2) 




AA 1 


B1 


B2 1 




1 CO 


1 D01 


D02 I 




1 Cl 


1 Dll 


D12 1 


Dim(4) 


1 C2 


1 D21 


D22 I 


Dim (5) 



Note: the 
must 
’mitr’ is 
’exit’ is 



columns and rows associated with the input w and the output zl 

have been scaled for gamma=l 

the max number of iterations 

the exit criteria as fraction of the cost 



Outputs : 

K- dynamic controller in packed (mutools) form 
count- iteration breakdown on ellipsoidal routine 
Psil,Psi2- upper/lower bounds for mixed cost 



7. dh2infopfb calls dfiric2, row, col (personal codes) and unpck from mu-tools 
7. toolbox as well as d2hinfsyn and its subroutines 
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'/, unpack system matrices 
[A A , B ,C,D] =unpck(p) ; 

nstates=Dim( 1) ; qcontrol=Dim(2) ; pdist=Dim(3) ; 

routput=Dim(4) ; moutput=Dim(5) ; 

noutO=row(C)-routput-moutput ; pq=Dim(2)+pdist ; 

tt=row(D)-moutput ; 

B1=B( : ,1 :pdist) ; B2=B( : ,pdist+l :pq) ; 

CO=C( 1 :noutO, : ) ; C1=C( (noutO+1 ) : noutO+routput , : ) ; 

C2=C( (noutO+routput+1) :row(C) , : ) ; 

D01=D(1 rnoutO, 1 rpdist) ; 

D1 1=D( (tt-routput+1) :tt , 1 :pdist) ; 

D21=D((noutO+routput+l) :row(C) , 1 rpdist) ; 

D02=D( 1 : (tt-routput) ,pdist+l :pq) ; 

D12=D( (tt-routput+1) : tt ,pdist+l :pq) ; 

D22=D( (noutO+routput+1 ) : row(C) ,pdist+l :pq) ; 



gam=l ; 

Ia=eye(Dl 1+D11 ' )-Dll*DU ' ; 

'/, solve the filtering equation 

[LI, L2,q terror, erf lgl]=dfiric2(AA' ,C1 ' ,C2’ ,B1' ,D11' ,D21 1 ,gam) ; 
if erflgl<=l, 

'/, Build Gfi(q), the augmented plant 
V=C2*q*C2'+D21*D21 1 ; 

R=Ia-Cl*q*Cl > +Cl*Q*C2 , *(V\C2*Q*Cl ' ) ; 

Z=AA*Q*C 1 '+B1+D11 '-(AA*q*C2'+Bl*D21')*(V\(C2*q*Cl'+D21*Dll 1 )) ; 

Vhalf =inv(sqrtm(V) ) ; 

Rhalf =inv(sqrtm(R) ) ; 

AAq=AA+Z* (R\C1 ) ; 

Blq=(AA*q*C2'+Bl*D21'+Z*(R\(Cl*q*C2'+Dll*D21')))*Vhalf ; 

B2q=B2+Z* (R\D12) ; 

D01q=(D01*D21 '+C0*q*C2' )*Vhalf ; 

Clq=Rhalf *C1 ; 

D1 lq=Rhalf * (Cl*q*C2 ' +D1 1*D21 ’ )*Vhalf ; 

D12q=Rhalf *D12 ; 

pq=pck( AAq, [Blq,B2q] ,[CO;Clq] , [DOlq ,D02 ; D1 lq ,D 12q] ) ; 

*/, compute the filtering cost 
Sf =C0*q*C0+D01*D01 '-DOlq+DOlq; 

'/, Now solve for the full-info gains which satisfy the hinf prob 

[Kf i ,Kp ,X ,E , count , Psil , Psi2 , outcome ,time] =dh2inf synl (f ,pq,Dim, Sf ,mitr , exit ) 

Kl=Kf i( : , 1 instates) ; K2=Kf i( : ,nstates+l : nstates+pdist ) ; 
else , 

error ( 'Filtering equation infeasible') 
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return 



end 

'/, Build controller 
Ac=AAq+B2q*Kl-(Blq+B2q*K2 ) *Vhalf *C2 ; 

Bc=(B lq+B2q*K2) *Vhalf ; 

Cc=Kl“K2*Vhalf *C2 ; 

Dc=K2*Vhalf ; 
k=pck(Ac , Be ,Cc ,Dc) ; 

*/, end d2hinfsyn 

D. Validation of the Ellipsoidal Codes 

While the ellipsoidal algorithm itself is very' simple, the complexity of the deriva- 
tion of the gradients and their translation into code was a fertile ground for mistakes. 
Means were consequently required to validate the results. Two methods were used to 
test their validity. First of all, Rotea presents results for an example problem in [Ref. 
29] where an ellipsoidal algorithm was used to determine a measurement-feedback 
controller by soliving the generalized 7i 2 synthesis problem . In coding the gener- 
alized mixed 7i 2 /Hi problem, a generalized 7i 2 algorithm was first written. These 
results matched Rotea’s data exactly. This 7i 2 code was then modified slightly to 
accomodate the constraint. Testing the satisfaction of this constraint on the 

final output was built directly into the termination criteria for the code. Secondly, 
each gradient subroutine was verified by calculating the gradient at multiple random 
points in the search space both using the subroutine and by a brute force differencing 
method. This comparison was very successful in finding errors in either the coding 
or in the original derivations. 



167 



APPENDIX BtCONTROLLER DESIGN 
EXAMPLE SCRIPTS 



This appendix documents the MATLAB scripts and simulink models that were 
used for the design and analysis of the autoland controllers in Chapter IV. The model 
used for both controllers was identical, and a single script prepared both synthesis 
models in order to ensure that the designs were for identical systems. Consequently 
several of the sections pertain to both designs. The first section presents the simulink 
models and the equation of motion function file from which the linearized models 
were extracted and which were used during the analysis. It also includes the scripts 
which established the linear synthesis models. The second section includes the scripts 
used to perform the state-feedback and measurement-feedback design for the 
controller. The third section includes the scripts which were used to design the mixed 
'Hi / Hcc> controller. 

A. NONLINEAR MODELS 
1. Equation of Motion 

The following equation of motion script was used at the core of all the 
nonlinear models to perform the calculation of the state derivatives. Since the F- 
H design problems were limited to longitudinal axis glideslope tracking problems, 
only the longitudinal states are considered. The requirement to perform robustness 
analysis and design also required the inclusion of uncertainty inputs and outputs 
in the equations of motion. These terms are reflected in the variables delta_in 
and delta_out. The stability derivative data was extracted from [Ref. 18] for a 
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flight condition of 134 KIAS and 11.7 degrees in the power approach configuration. 
Because the control power derivatives for the DLC were unavailable, it was scaled 
to produce 0.1# of vertical acceleration, and 0.01# of horizontal deceleration at a 
deflection of 0.5 rad. True states were calculated internal to the equat ions of motion, 
and perturbation states were therefore integrated exterior to the equations of motions. 
This architecture simplified simulation and trimming, since all signals external to the 
equations of motions were perturbation states. The trimmed lift and drag coefficients 
were adjusted from their handbook values because they were slightly inconsistent 
with the values necessary to trim the model at the specified thrust and weight. 
eom4 



function statedot=eom4(state ) 

*/, determines continuous time state derivative for nonlinear longitudinal 
*/, equations of motion. 

•/. This version all states read in are the perturbation states 

*/, flight condition: 
g=32.174; 
ra=54000/g ; 

Iyy=247194 ; 

S=565 ; 
cbar=9 . 8 ; 
alphaT=0; 
zT=0 ; 

V0= : 134* 1 . 6889 ; 
rho=. 002376; 
alpha0=ll .4/57.3; 
thetaO=alphaO ; 

T0=131 18 ; 

F-14 derivatives 

CDt=0 . 37405269 ; % trimmed coefficients (these differ from handbook) 

CLt=l .49534913; 

Cmt=0 ; 

CDU=0 ; 

CLU=0 ; 

CMU=0 ; 

CDA=0. 0208*57. 3; */, rad~-l 

CLA=0. 0799*57. 3; */. rad~-l 



y. fps 
y. slugs 
y. siug-f t~2 
y. ft ~2 

y ; ft 

'/, thrust incidence (radians) 

'/, thrust couple 
'/. fps 

y. slug/f t ~3 
*/. rad 

'/, rad - trim point is level flight 
*/. lbs 
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CMA=-0. 0115*57. 3; 
CDQ=0 ; 

CLQ=5 . 45 ; 

CMQ=-14 . 3 ; 

CDAD=0 ; 

CLAD=~0 . 51 ; 
CMAD=-0 . 93 ; 



*/, rad*- 1 



*/, rad*-l 
*/, rad*-l 



*/. rad*-l 
*/, rad~-l 



CDIS=0 ; 

CLIS=0. 0141*57. 3; 
CMIS=-0 . 0201*57 . 3 ; 



y, rad*- 1 
'/, rad*-l 



*/. the DLC control power is scaled to permit . lg at full deflection of .5 radians 
CLDLC=0 . l*CLt/ (0.5) ; 

CDDLC=0 . 1*CLDLC ; 

CMDLC=0 ; 

y. Unpack perturbation states 
du=stat e ( 1 ) ; 
dalpha=state(2) ; 
q=state(3) ; 
dtheta=state(4) ; 

stab=state (5) ; */. These are perturbation deflections 

dT=state(6) ; 

DLC=state(7) ; '/, ditto 

delta_in= [state (8) ; state (9) ; state ( 10)] ; 

*/* Calculate true states 
u= (du+cos (alphaO) ) *V0 ; 
alpha=dalpha+alphaO ; 
theta=dtheta+thetaO ; 

T=T0+dT ; 

'/, Calculate the dynamic pressure 
V=u/cos (alpha) ; 

Q=0 . 5*rho*V*2 ; 

*/, following matrix incorporates both fixed constants and rotation from stab 
'/. axis to body axis 

Rwb= [-cos (alpha) sin(alpha) 0 ; -sin(alpha) -cos(alpha) 0;0 0 1]; 

Rbw=Rwb ' ; 

QT=Q*S* [-cos(alpha) sin(alpha) 0 ; -sin(alpha) -cos(alpha) 0;0 0 cbar] ; 

'/. LHS comprises mass matrix and alphadot aero forces 
LHS=diag([m*V0 > m*V > Iyy])-QT*(cbar/2/V)*[CDAD CLAD CMAD]’*[0 1 0]; 

*/. Determine coupling term (body axes) 

Fcouple=m*q* [-sin(alpha)*V; u; 0] ; 

*/. Determine gravity term (body axes) 

Fgrav=m*g* [-sin(theta) ; cos (theta) ; 0] ; 



170 



'/, Determine thrust term (body axes) 

Fthrust=T* [cos (alphaT) ; sin(alphaT); zT] ; 

'/. Build aero forces in stability axes and then rotate to body axes 
Trim=[CDt; CLt ; 0]; 

Derv= [CDU+VO CDA CDQ; CLU*V0 CLA CLQ ; CMU*V0 CMA CMQ] ; 

CPower= [CDIS CDDLC ; CLIS CLDLC ; CMIS CMDLC] ; 

Faero=QT* (Trim+Derv* [du; dalpha ; q*cbar/2/V] +CPower* [stab; DLC] + delta.in) ; 
delta_out=Derv* [du ; dalpha ; q*cbar/2/V] +CPower* [stab; DLC] ; 

statedot l=LHS\(Fcouple+Fgrav+Fthrust+Faero) ; 

thetadot=q ; 
gamma=theta-alpha; 
wdot=statedot 1 (2)*V ; 

hdot= sin (gamma) *V/V0 ; X Note that hdot is scaled by velocity 

statedot= [statedot 1 ; thetadot ; hdot; udot; V ; delta.out] ; 

'/, end eom4 



2. Openloop Simulink Model 

The open-loop simulink model from which the synthesis model was ex- 
tracted is presented in Figures B.l. B.2, and B.3. The model includes the actuator 
models, as well as the appended integrators on the outputs of interest. As discussed 
in Chapter IV, additional integrators were required midway through the design pro- 
cess in order to achieve the desired tracking properties. These figures include the 
additional appended integrators. These models were not used for any simulation, but 
represented a graphical means of accounting for the paths of various signals through 
the system. 

3. Synthesis Model Construction 

The following script performed the function of ext racting the linear model 
and creating the state-space formulations for both the controller design and the 

mixed design. Beyond the linearization itself, the principal purpose of this script was 



C/) 




Figure B.l: Open-Loop Simulink Model 
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nonlinear plant + actuators 




Figure B.2: Non-Linear Plant and Actuators Block 

to perform the necessary bookkeeping functions of collecting the appropriate channels 
into the appropriate inputs and outputs of the vectors w, Zq , z i, and y. Finally, some 
baseline scaling of the input and output signals was performed. The system matrices 
were then compiled in a //-tools system matrix format [Ref. 24] to be passed to the 
appropriate design codes, 
plant 10c 



'/. Establish synthesis plaint for mixed controller and hinf design problem 
'/, This uses the fl4 model extracted from fl4nlaero5 
*/♦ This problem is a glideslope tracker with 
*/♦ with double integrators on DLC and alpha 

Delta=0 . 2*eye (3) ; 

taul=0.4; '/« power plaint time constant (2.5 rad/s) 

tau2=0 . 05 ; */. horizontal stab time constaint (20 rad/s) 

tau3=0.02; '/, DLC time constant (50 rad/s) 

sigma_gam=3/57 . 3 ; '/rad 
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Demux Mux 



yuhdot.h.alpha.q.thet, 

udot,wdot,V,DLC 



Figure B.3: Output Integrators Block 



U0=134*l . 6889 ; 

[AA ,BB , CC ,DD] =linmod( J f 14nlaero5 » ) ; 

*/, linmod orders states (14): 

*/* h_er/s2,alphaer/s2 ,DLC/s2,u , alpha, q, theta, stab, T ,DLC ,h ,alp_er/s ,h_er/s ,DLC/s 

*/, inputs: (21) 

'/, h_cmd ,alp_crad ,DLC_cmd, 13 noises , stabc ,Tc ,DLCc , del 1-3 
'/* outputs: (18) 

*/* h_er/s2 ,alper/s ,DCL/s ,hdot ,h, alpha, q, theta, Nx , (Nz-1) ,V,DLC, 

*/, stabcmd,Tcmd,DLCcmd,dell-3 



plant be input in form 



'/, Requires 

y. 

y, xdot= AA*x 

y. zo= co*x 

•/. zi= ci*x 

y. y= C2*x 



+ Bl*w + B2*u 
+ + D02*u 

+ + D12*u 

+ D21*w 



'/. , a > represents the full output feedback plant 

'/. ’b* is reduced statef eedback plant (noise columns stripped) 
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Bla=BB ( : ,[1:15,19:21]); Blb=BB ( : , [1 : 3 , 19 : 21] ) ; B2=BB(: ,16:18); 

*/, ******+******Build Pure Hint Plant matrices ************************** 

'/, Important: delta scaled by factor of .2 already 

*/. zl : h_er/s , alper/s , DCL/s ,stabcmd ,Tcmd ,DLCcmd, udot ,alphadot ,qdot , thetadot , hdot , 

*/. dell-3 (14) 

Cla= [CC( [1:3,13:15] , :); AA( [4:7, 11] , : ) ; CC(16: 18, : )] ; 

D1 la=zeros( 14 , 18) ; D1 lb=zeros ( 14 ,6) ; 

D12a=[DD([l:3, 13: 15] ,16:18); B2( [4:7,11],:); DD( 16 : 18 , 16 : 18)] ; 

'/, y: h_er/s2 , alper/s2 ,DCL/s2 ,h , alpha , q , theta , Nx , (Nz-1 ) ,V (10) 

C2=CC ([1:3,5:11],:); 

D21=DD( [1:3,5: 11] ,[1:15,19:21]); D22=DD( [1 : 3 , 5 : 1 1] ,16:18) ; 

'/, Pack mixed output feedback plant 

pnom_a=pck(AA, [Bla B2] , [Cla;C2] , [D 1 la,D12a;D21 ,D22] ) ; 

'/, Pack statef eedback plant 
pnom_b=pck( AA , [Bib B2] , Cla , [D1 lb D12a] ) ; 

'/, To scale outputs for hinf: zl- rows 14:27 

*/, del are rows 25:27, and col 29:31 

*/, ******************** Build Mixed Plant matrices ************************* 

'/, Important: delta scaled by factor of .2 already 

'/, zO : h_ er /s , alper/s , DCL/s , stabcmd , Tcmd , DLCcmd , udot , alphadot , qdot , thetadot , hdot (11) 
C0= [CC( [1:3,13: 15] , :) ; AA( [4:7, 11] , : )] ; 

D01c=zeros(ll , 18) ; D01d=zeros ( 1 1 ,6) ; 

D02= [DD( [1:3, 13: 15] , 16: 18) ; B2( [4 : 7 , 1 1] , : )] ; 

'/, zl: h_er/s , alper/s , DCL/s , stabcmd , Tcmd , DLCcmd , dell-3 (9) 

C1=CC ([1:3,13: 18] , : ) ; 

Dllc=zeros(9 , 18) ; D1 ld=zeros (9 , 6) ; 

D12=DD([l:3, 13:18], 16:18); 

'/, Pack mixed output feedback plant 

pnom_c=pck( AA , [Bla B2] ,[C0;C1;C2] , [DOlc D02;DUc,D12;D2l ,D22]) ; 

'/, Pack statef eedback plant 

pnom_d=pck( AA , [Bib B2] ,[C0;Cl] , [DOld D02 ; D1 Id ,D12] ) ; 

'/, To scale mixed outputs: zO- rows 15:25; zl- rows 26:34 

'/, To scale inputs: noise cols 18:29 

'/, Scale Nominal Mixed Plants: 

Scale l=diag( [0 . 001 ,0 . 001 ,0 .001 ,0. 001 ,0. 000001 ,0 . 001 ,2*ones( 1 ,3)] ) ; 
pnom_c(26: 34 , : ) =Scale l*pnom_c (26 : 34 , : ) ; 
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pnom_d(26 : 34 , : )=Scalel*pnom_d(26 : 34 , : ) ; 
7. Scale u 

pnom_c( : , 15: 17) =0 . 01*pnom_c( : ,15: 17) ; 
pnom_d( : , 15 : 17)=0. 01*pnora_d( : ,15: 17) ; 

sdof =14*15/2+3*14 ; 

Dimd= [14 3 6 9 sdo f] ; 

Dimc= [14 3 18 9 10 sdo f] ; 

Sf=zeros(row(C0) ) ; 

7, end plant 10c 



4. Closed-Loop Analysis Models 

Figure B.4 depicts the simulink model used both for the nonlinear simula- 
tion and the robustness analysis. A T> implementation of the various controllers was 
used and can be observed in Figures B.5 and B.6, where the measurement channels 
are differentiated prior to the controller, and then the output of the controller passes 
through double integrators. 

B. Ho* DESIGN SCRIPTS 

The following scripts performed the design process including the appropri- 
ate scaling of the weighting functions, calling the design code itself, and then analyzing 
the resulting system. The two subroutines sfbanal5 arid snsrloop performed the 
analysis of the state-feedback system and the analysis of the sensor responses. 
loopshape5 

7. Control Design and analysis for plantlOc 

7. PlantlOc is extracted from fl4nlaero5. Includes double integrators 

7. on altitude, alpha, and DLC to track altitude and washout alpha and DLC in 

7. response to a ramp altitude input. 



7* Broken_loop analysis for output feedback 

7. 

7. Determines pure hinf dynamic controller 




o 

Q 



3 



Figure B.4: Closed-Loop Simulink Model 
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in 4 



Demux 



Figure B.5: Controller Block 




Demux Mux 



y1=hdot,h,alpha.q,thet, 

udot,wdot,V,DLC 



Figure B.6: Output Integrator Block 




7. Plots brkloop control response vs. sfb design 
7, Plots clsdloop command response 
7. Plots clsd loop sensor response 
plantlOc 

7. sfb problem weights — [2 2.15110555100 0] 
sfbanal5, Ksfb=K; 

7. opfb problem weights 

7.[p2o,pl]=scalel5(pnom_a,pnom_b, [2 5 .5 5 1 5 0 5 5 5 .1 0 0 0]); 
[p2o , pl]=scalel5(pnom_a, pnom_b, [10 30 5 5 .01 10 10 5 1000 0]); 

distscale= [1,1,1,. 00001* [ . 1 4 4 0 .01 .01 .01 . 1 10 10 1 0 5 5 5]]; 
p2=p2o; p2( : , 15:32)=p2o( : , 15 : 32)*diag(distscale) ; 

7. calculate hint opfb controller 
K = hinfsyn(p2, 10, 3, 0,50000, 500); 

[Ac , Be , Cc , Dc] =unpck(K) ; 

AAcl=[AA B2*Cc ; Bc*C2 Ac+Bc*D22*Cc] ; 

snsrloop4 

Bstar= [B2;zeros(size(B2) )] ; 

Cstar= [zeros (size(Cc)) ,Cc] ; 

W=logspace(-3 ,3,100) ; 



7. 

7. broken loop controller response 
7. 



Ka=Cc; Ka( 1 , : )=zeros ( 1 , 14) ; 

Tuul=pck( [AA , B2*Ka; Bc*C2 , Ac+Bc*D22*Cc] , Bstar( : , 1 ) ,Cstar(l , : ) ,0) ; 
BrkLoopl=frsp(Tuul , V) ; 

Kb=Cc; Kb(2 , : )=zeros ( 1 , 14) ; 

Tuu2=pck( [AA,B2*Kb;Bc*C2, Ac+Bc*D22*Cc] ,Bstar( : ,2) ,Cstar(2, : ) ,0) ; 
BrkLoop2=frsp(Tuu2,V) ; 

Kc=Cc; Kc(3 , : )=zeros ( 1 , 14) ; 

Tuu3=pck( [A A , B2*Kc ; Bc*C2 , Ac] ,Bstar( : ,3) ,Cstar(3 , : ) ,0) ; 

BrkLoop3=frsp(Tuu3, V) ; 

f igure(7) , 

vplot( ’liv^m* ,BrkLoopl , ’r-’ ,BrkLoop2, ’g — * ,BrkLoop3, ’b-. , ,sfbloops , *y ’ ) .grid 
title( 'Broken Loop Controller’), 

figure (8) , vplot ( ’nyq’ .BrkLoopl , ’r- * , BrkLoop2 , ’g — * ,BrkLoop3 , ’b- . * ,sfbloops , ’y * ) , 
grid, title( * Nyquist Plot’), 

axis ([-5 5 -5 5] ), axis (* square ’), axis (* equal ’) , 



7 . 

7, Open Loop controller response 

7 . 



Kc=zeros (3 , 12) ; 

Tuu4=pck( [A A .zeros (14,14) ;Bc*C2,Ac] , Bstar , Cstar , zeros (3 , 3) ) ; 

0penloop=vsvd(frsp(Tuu4,W)) ; 

figure (9) , vplot ( * liv ,1m’ ,Openloop) ,grid, 

title( 1 Open-loop Controller Response*) 

7* Closed loop command response 
Bin= [BB( : ,1:3) ; zeros ( 14 , 3)] ; 

Cout= [CC( [5:6, 12] , :) , [zeros (2, 14) ;DD (12, 16: 18)*Cc]] ; 

Cout2= [CC( [5:8,13:15] , : ) ,DD( [5:8,13: 15] ,16:18)*Cc] ; 

Thh=pck(AAcl ,Bin( : , 1 ) ,Cout (1 , : ) ,0) ; 

Tvv=pck(AAcl , Bin( : ,2) ,Cout (2 , : ) ,0) ; 

Ttt=pck ( AAcl ,Bin( : ,3) ,Cout(3, : ) ,0) ; 

Cloopl=f rsp(Thh , W) ; 

Cloop2=f rsp(Tvv , W) ; 

Cloop3=f rsp (Ttt ,W) ; 

f igure( 10) , 

vplot ( ’liv,lm’ ,Cloopl , *r’ ,Cloop2, ’g’ ,Cloop3, ’b’ ,sfbcmdloop, *c’ ,dB3thres, *m’ ) , 
title( 'Closed Loop Conunand Responses’), 

7. Closed-loop eigenvalues 
[V , E] =eig( AAcl) ; E=diag(E) ; 

disp(’Closed Loop eigenvalues amd damping ratios’) 

[E, -cos (angle (E) )] 

7. Open Loop eigenvalues and controller zeros 
disp( ’Open-Loop Poles’) 

El=eig( AA) 

disp( ’Controller Zeros’) 

Kzero=tz(Ac , Be ,Cc ,Dc) 



7 . 

7. mu analysis of the closed-loop systems 

7 . 



disp( ’do you want to do the mu analysis?’) 

disp( ’Type qq=0 , followed by return to stop, else type return’) 

qq =1 ; 

keyboard 

if qq==0, return, end 
W=logspace(-2,3) ; 



ISO 



'/, sfb mu 

Asf b=( AA+B2*Ksf b) ; 

Tdel=pck( Asfb, BB( : , 19 : 21 ) , CC( 16 : 18 , : ) , DD( 16 : 18 , 19 : 21 ) ) ; Tdelrsp=f rsp(Tdel , W) ; 
MuTsfb=mu(Tdelrsp, [1 1;1 1 ; 1 1]); 

'/, opfb mu 
U0= 134* 1 . 6889 ; 

Delta=0. 2*eye(3) ; 

[Ad , Bd , Cd , Dd] =linmod( *f 14nlclsd5 * ) ; 

Tdel2=pck( Ad , Bd( : f 16 : 18) ,Cd( 16 : 18 , : ) ,Dd(l6: 18 , 16 : 18) ) ; 

Tdel2rsp=f rsp(Tdel2 , V) ; 

MuTopf b=mu (Tdel2rsp , [1 1 ; 1 1;1 1]); 

figure(ll) , vplot ( * liv ,1m 1 ,MuTsfb, * - 1 , MuTopf b, * — * ) , 

'/, title( 'Structured Singular Values*), 
grid 



sfbana.I5 



'/, Scale output vector zl 

*/, [p2,pl]=scalel5(pnom_a,pnom_b, [2 2.1 SI 10555 100 0]); 
[p2 ,pl] =scalel5(pnora_a,pnora_b , [10 30 5 5 .01 1 0 10 5 1000 0]); 

'/, zero out uncertainty columns 

pi ( : , 17 : 19) =zeros (s ize(pl ( : , 17 : 19) ) ) ; 

•/, Analysis of state feedback control system 
K = hinffi(pl, 3, 0,50000, 1000) ; 

nn =80; 

W=logspace(-3 , 3 ,nn) ; 

K=K(: ,1:14); 

'/. broken loop controller response 

Ka=K ; Ka( 1 , : )=zeros ( 1 , 14) ; 

Tuul=pck(AA+B2*Ka, B2( : , 1 ) ,K( 1 , : ) ,0) ; 

BrkLoopl=f rsp(Tuul , W) ; 

Kb=K ; Kb(2 , : )=zeros (1,14) ; 

Tuu2=pck(AA+B2*Kb, B2( : ,2) ,K(2, : ) ,0) ; 

BrkLoop2=f rsp(Tuu2 , W) ; 

Kc=K; Kc (3 , : )=zeros( 1 , 14) ; 

Tuu3=pck(AA+B2*Kc, B2( : ,3) ,K(3, : ),0) ; 

BrkLoop3=frsp(Tuu3 , W) ; 

sfbloops= [BrkLoopl ( 1 : nn , 1) ,BrkLoop2( 1 : nn, 1) , BrkLoop3( 1 : nn , 1)] ; 
sf bloops=vpck(sf bloops ,getiv(BrkLoopl ) ) ; 
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f igure( 1 ) , vplot ( *liv , lm * , BrkLoopl , 'r- 1 , BrkLoop2 , *g — * , BrkLoop3 , , b- . * ) 
title( * Broken Loop Controller Response ’), grid 

f igure(3) , vplot( 'nyq* , BrkLoopl , *r- * ,BrkLoop2, *g — ’ ,BrkLoop3, *b- . * ) , 
axis([-5 5 ”5 5]), grid 

7, closed loop command response 

Thh=pck(AA+B2*K,Blb( : ,1) ,00(8, : )+DD(5 , 16 : 18) *K ,DD(5 , 1 ) ) ; 

ClsdLoop4=frsp(Thh,V) ; 

Tvv=pck(AA+B2*K ,Blb( : ,2) ,CC(6, : )+DD(6, 16: 18)*K,DD(6,2) ) ; 

ClsdLoop5=f rsp(Tvv ,W) ; 

Ttt=pck (AA+B2*K , Blb( : , 3) , CC( 12 , : )+DD( 12 , 16: 18 ) *K ,DD( 12 , 3) ) ; 

ClsdLoop6=f rsp(Ttt , W) ; 

sfbcmdloop= [ClsdLoop4( 1 : nn , 1) ,ClsdLoop5( 1 :nn, 1) , ClsdLoop6( 1 :nn, 1 )] ; 
sfbcmdloop=vpck(sfbcmdloop ,get iv(ClsdLoop6) ) ; 

dB3thres=cos(pi/4)*ones(size(W) ) ; 

f igure(2) ,vplot( , liv,lm > ,ClsdLoop4, J r- 1 ,ClsdLoop5, *g — * ,ClsdLoop6, , b-. * ,dB3thres, *y : *) 
title (' Closed Loop Command Response 1 ), grid 



[V , E] =eig( AA+B2+K) ; E=diag(E); V=abs(V); 
[E, - cos ( angle (E) )] 

return 



snsrloop4 

'/, Analysis of the sensor responses 
'/, Intended for call by loopshape script 

Blq= [zeros (size (Be) ) ;Bc] ; 

CCq= [zeros (size(CC) ) , CC] ; 

WW=logspace(-5 ,5 , 100) ; 

*/, closed loop sensor response 

snsrl=pck(Ac ,Bc(:,l),C2(l,:),0); 
SnsrLoopl=frsp(snsrl ,WW) ; 

snsr2=pck(Ac ,Bc( : ,2) ,C2(2 , : ) ,0) ; 
SnsrLoop2=f rsp(snsr2 , WW) ; 

snsr3=pck(Ac ,Bc(:,3),C2(3,:),0); 



182 



SnsrLoop3=f rsp(snsr3 , WW) ; 

snsr4=pck( Ac ,Bc( : ,4) ,C2(4 , : ) ,0) ; 

SnsrLoop4=f rsp(snsr4 , WW) ; 

snsr5=pck( Ac ,Bc(:,6),C2(5,:),0); 

SnsrLoop5=frsp(snsr5 , WW) ; 

snsr6=pck(Ac , Bc(:,6),C2(6,:),0); 

SnsrLoop6=f rsp(snsr6 , WW) ; 

snsr7=pck(Ac ,Bc( : ,7) ,C2(7, : ) ,0) ; 

SnsrLoop7=f rsp(snsr7 , WV) ; 

snsr8=pck ( Ac ,Bc( : ,8) ,C2(8, : ) ,0) ; 

SnsrLoop8=f rsp(snsr8 , WW) ; 

snsr9=pck(Ac ,Bc( :,9),C2(9,:),0); 

SnsrLoop9=f rsp(snsr9 , WW) ; 

snsr 10=pck(Ac , Be ( : , 10) ,C2( 10 , : ) ,0) ; 

SnsrLooplO=f rsp(snsr 10 , WW) ; 

f igure(4) ,clg 

vplot ( * liv , lm * , SnsrLoop7 , * -* , SnsrLoop8 , ’ — ’ , SnsrLoop9, * - . * , SnsrLooplO , * ) .hold on 

vplot ( * liv ,1m' , SnsrLoop4 , *r- ’ , SnsrLoop5 , ' g — ’ ,SnsrLoop6 , *b- . * ) 
vplot ( * liv , lm* , SnsrLoopl , * r - * , SnsrLoop2, 'g — * , SnsrLoop3 , 1 b- . * ) 

return 



C. MIXED n 2 / Hno CONTROLLER DESIGN SCRIPTS 

The script in this section was used to design the mixed controller described in 
Chapter IV. 
msfbanal 



7, Design and Analysis of mixed state-feedback control system 
plant 10c 
p=pnom_d ; 

y.scale zO 

z0scale=[l f 10000,1 ,1000, 1, .1,0,0, 0,0,0]; 
p( 15 : 25 , : ) =diag(z0scale ) *p( IS : 25, : ) ; 

[K,Kp,X,E,ct,Pl,P2,oc,t]= h2infsyn(l ,p,Dimd,Sf ,25000,0.01) ; 
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Ksf b=K ; 



nn =80; 

W=logspace(-3 ,3 ,nn) ; 

7, broken loop controller response 

Ka=K; Ka(l , : )=zeros(l , 14) ; 

Tuul=pck(AA+B2*Ka,B2( : , 1 ) , K( 1 # : ) , 0) ; 

BrkLoopl=f rsp(Tuul , W) ; 

Kb=K ; Kb(2 , : )=zeros(l , 14) ; 

Tuu2=pck(AA+B2*Kb, B2( : ,2) ,K(2, : ) ,0) ; 

BrkLoop2=f rsp(Tuu2 , W) ; 

Kc=K ; Kc (3 , : ) =zeros (1,14) ; 

Tuu3=pck(AA+B2*Kc , B2( : , 3) ,K(3 , : ) , 0) ; 

BrkLoop3=f rsp(Tuu3 , W) ; 

sf bloops= [BrkLoopl (l :nn, 1 ) ,BrkLoop2(l : nn , 1) , BrkLoop3( 1 :nn, 1)] ; 
sfbloops=vpck(sfbloops , get iv( BrkLoopl ) ) ; 

f igure( 1) , vplot ( 'liv ,1m* , BrkLoopl , 'r-' ,BrkLoop2 , 'g — * , BrkLoop3 , 'b-. * ) 
title( 1 Broken Loop Controller Response ' ) ,grid 

figure (3) , vplot ( 'nyq' , BrkLoopl , *r- 1 ,BrkLoop2 , 'g — ' , BrkLoop3 , 'b- . ’ ) , 
axis([-5 5 -5 5]), grid 

7. closed loop command response 

Thh=pck (AA+B2+K ,Blb( : ,1) ,00(5, : )+DD(5, 16: 18)*K,0) ; 

ClsdLoop4=f rsp(Thh , W) ; 

Tvv=pck(AA+B2*K,Blb(: ,2) ,00(6, : )+DD(6, 16: 18)*K ,0) ; 

ClsdLoop5=f rsp(Tvv ,W) ; 

Ttt=pck(AA+B2*K,Blb( : ,3) ,00(12 , : )+DD(12 , 16: 18)*K,0) ; 

ClsdLoop6=f rsp(Ttt ,W) ; 

sfbcmdloop= [ClsdLoop4(l : nn , 1 ) ,ClsdLoop5( 1 :nn, 1) ,ClsdLoop6(l :nn , 1)] ; 
sf bcmdloop=vpck(sf bcmdloop ,getiv(ClsdLoop6) ) ; 

dB3thres=cos (pi/4)*ones (size(W) ) ; 

figure (2) , vplot ( 'liv , lm’ ,ClsdLoop4 , 'r- 1 ,ClsdLoop5 , 'g — * ,ClsdLoop6 , 'b- . ' ,dB3thres , ’ y : ' ) 
title( 'Closed Loop Command Response ') ,grid 

[V , E] =eig( AA+B2+K) ; E=diag(E) ; V=abs(V); 

[E, -cos (angle (E) )] 

return 

% end msfbanal.m 
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APPENDIX C:INTERIOR POINT CODES 



A. GENERAL REMARKS 

This appendix documents the interior point codes used during for many of the 
example problems cited in the body of the report . The codes and their structure are 
briefly described followed by a verbatim listing of the routines. The codes are followed 
by comments on practical issues of their use. The original codes upon which these 
are based were provided by Professor Khargonekar of the University of Michigan and 
were the result of work performed by Enrique Bayens, his student. The algorithm 
follows [Ref. 14] as outlined in Chapter II, and is written as MATLAB function files. 

These codes are problem independent, and are structured to solve the Eigenvalue 
Problem (EVP), or the more general Generalized Eigenvalue Problem (GEVP). Recall 
that the GEVP has the form: 



Minimize: A, 



Subject to: 



\B{x) - A(x) 0 0 

0 B{x) 0 

0 0 C(x) 



> 0 , 



where A ( .r ) = do+ElLi 3\‘A;, B(x) = + XZT= i • r iB t , and C(x) = Co + ]Cr=i The 

EVP is the simplified case where B(x) = /. We will refer to the set {A 0 , Ai, . . . , A n } 
as the basis for the affine matrix functional A(.r). The application of these codes to 
any particular problem simply requires that the problem be posed as a GEVP and 
the three sets of bases determined and stored. 

1. Posing a Basis 

Two important structural concepts introduced in Bayens' original code 
provide a mechanism for passing these bases to the interior point routines. The first 
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is what he calls an “a-matrix*’ , which is simply an accounting method for storing a 
basis as a single argument, which can easily be passed from function to function in 
MATLAB’s workspace. For example if A(x) = /io + H" =1 then the corresponding 
a-matrix is Aa= [A 0 , A \ , . . . , A n ]. For many control problems, these matrices can be 
huge, and the interior point methods can consequently be RAM intensive. In many 
applications, the matrices A(x) and/or C(.v) may have structure. That is, A ( .r ) or 
C(.r) may themselves be comprised of diagonal blocks of matrices. In this case, it is 
advantageous to use the structure to reduce the computational expense. The codes 
each then ask for a structure matrix Sc, which defines the internal structure of a set 
of basis matrices Ca. The number of rows of S is then the number of blocks in C(x). 
Each row has two scalar values. The first value is a “F or “0”, and signifies whether 
the associated block is a full block, or is itself a diagonal mat rix. The second value in 
that row defines the size of the block, i.e., the number of rows and columns. These 
bases are then passed to the interior point routines, along with an initial feasible 
point and any knowledge of the internal structure of A(.r) or 0(.r). Note that for 
all the problems actually solved in this report, the EVP was considered and so the 
a-matrix for B(x) was Ba= [/, zeros], with sufficient zeros such that the size of Ba 
was identical to the size of the a-matrix Aa. 

2. Modifications to the Original Code 

The codes presented here are structurally identical to the originals, but 
differ substantially in execution. The architecture of the inputs, outputs and sub- 
routines are unchanged. Most of the changes were in the interest of either numerical 
efficiency or accuracy. Several changes, for example, took advantage of the structure 
of many LMFs to reduce the number of multiplications bv blocks of zeros. 



187 



Fhe most important changes dealt with the way in which matrix divisions 
were handled. The interior point codes involve frequent divisions by positive definite 
matrices. The original codes extensively used MATLAB’s inv function. Replace- 
ment with MATLAB’s matrix division notation was occasionally satisfactory and 
efficient, as MATLAB 4.0 first attempts division by Cholesky factorization for any 
symmetric matrix. Many of the divisions, however, involve positive definite matrices 
which are very badly conditioned, to which MATLAB responds with a warning mes- 
sage. This is to be expected since one is trying to force an LM1 to the boundary only 
t away from singularity. At the suggestion of Professor Laurent El Ghaoui (ENSTA, 
Paris), all poorly conditioned divisions were executed by first performing an eigen 
decomposition of the positive definite denominator. The result is a real diagonal ma- 
trix of eigenvalues and an orthonormal matrix of eigenvectors (H~ l L = U A -1 U 1 L, 
where // = UAU T ). Multiplying by orthonorinal matrices and then division of each 
row by the corresponding scalar eigenvalue optimized the accuracy of the process. 
Consequently the expression: 

HL=inv(H)*L; 
was replaced with: 

[UH,DH]=eig(H) ; 

L1=UH J *L; 

for i=l : order(H) , 

L2(i , : )=DH(i , i)\Ll(i , : ) ; 

end 



HL=UH*L2 ; 



This is not at all the most efficient, means of performing the division, hut their badly 
conditioned nature lias led more notable researchers to choose the accuracy implicit 
in this approach. It is however much faster than allowing MATLAB’s matrix division 
function to wrestle with very poorly conditioned divisions. 

3. The Principal Code 

The function centers3, and its variations is the top level program that 
solves the EVP. The “3” simply identifies the code as being the third variation to 
Bayens’ original. Three variations to centers3 were used. The first centers3b simply 
suppressed workspace printing. The next centers3c suppressed workspace printing 
and included the structure of A as an input, argument, (the original had only used the 
structure of C). Finally, centers3d restored workspace printing, while continuing to 
permit the structure of both A and C to be passed. 

As discussed above, centers3 is not problem specific, but suitable for 
solving any EVP. As input arguments it requires the bases (a-matrices) associated 
with the three EVP matrix functionals, (A(.r), /i, ( f (.r ))); a matrix which defines any 
internal structure of the problem; and feasible initial conditions x and A from which 
to start the search. (Finding a good initial point is discussed later in this appendix). 
The remaining inputs are numerical thresholds and adjustments. Since centers3 
is not problem specific, it was used for all EVP's, including the mixed discrete and 
continuous problems, and the plant optimization problems. In each of those cases, 
scripts were written which prepare the a-matrices appropriate to each problem, and 
determine a suitable initial conditions before calling centers3. 

As written by Bayens, the original centers was intended to solve the more 
general GEVP, but a bug in the subroutine assump2 led me to close the path such 
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that only constant B matrices were permitted. Since a GEVP solver was not required 
during this work, the bug was not isolated or corrected. Little work should be required 
in order to permit the code to solve the GEVP, if it becomes required. 

4. The Subroutines 

A large number of function files accompany and are called by the central 

function, centers3. Several of these functions could be regarded as administrative, 

and are used to manipulate a-matrices. They are useful both within centers3, 

and also in preparing a-matrices in problem specific applications prior to calling 

centers3. The functions affin and getvec use the a-matrix (basis) of A to map 

back and forth between x and A(,r) = affin(/la, x) and x — getvec( Aa, A(x)). 

The function adiag manipulated a-matrices of D(x) and B(x) to find the a-matrix 

D(x) 0 



of the functional F(x) = * ri/ . . This was used extensively whenever two 

f 0 E ( x ) 

LMPs were jointly imposed. 

The following set of functions could rightly be called subroutines, as their 
use is restricted to calls from within centers3. The functions assumplb, assump2, 
and assump3c checked the necessary assumptions before starting the method of 
centers. First, assumplb verified that the initial point is feasible. Next, assump2 
confirmed that B(x) was bounded away from singular for the GEVP. It currently 
not called by centers3, and would have to be fixed in order to solve the GEVP. It 
is included here for completeness. The subroutine assump3c actually performed 
the first iteration of the search for a analytical center in order to determine if t lie 
problem is bounded. If this first iteration converged, then the problem was considered 
bounded. The majority of the work was performed by the subroutine nesnem3a, 
which actually performed the search for the analytic center within the inner-loop of 
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the method of centers. Within its loop, it in turn called grad2b, which returned the 
gradient and hessian at each step of the search. 

B. PRACTICAL ISSUES 

This section addresses a number of practical issues regarding the use of these 
codes. The first of these comments is relevant to the use of any interior point codes 
for the solution of LMI’s. Subsequent remarks pertain specifically to the author’s 
experience in the use of this particular implementation. 

1. Determining a Feasible Initial Point 

All the interior point methods are dependent upon initializing the optimiza- 
tion with x^ and A* 0) in the feasible set, i.e. A (0) / — A(x^) > 0 and C(x^). In fact, 
the codes in section 0 verified this requirement prior to any optimization attempt. 
As a matter of practical experience, it is not just enough to initialize the algorithm 
at any feasible point, but ideally a point well away from the boundary for which the 
problem becomes singular (unfeasible). Riccati methods are a very poor choice for 
determining a feasible initialization point. This is because the numerical methods 
for solving the Riccati equation must generally make allowance for a tiny negative 
eigenvalue in an otherwise positive definite solution. Even a very tiny negative eigen- 
value however places the corresponding vector x outside boundary function of the 
LMI with no means of crossing the boundary. One method, suggested by El Ghaoui, 
is to perform a preparatory optimization by setting C(x) = 1 > 0, x = [0, . . . , 0] 7 , 
and minimizing A such that A / + U(.r) > 0. For the original problem to be feasible, 
a A < 0 must exist. Furthermore, by minimizing A < 0 (finding its maximum nega- 
tive absolute value), the “best” feasible value of x^ is determined. The problem of 
interest can then be initialized with .r* 0) and some A* 0 * >> A mar ( A(.r (u) ). 
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A modification to this approach was routinely used. Specifically C(j') usu- 

R(.r) 

Y(x) 

x were the diagonal elements of Y. In this case the preparatory problem was posed as 



ally had some structure such as C ( x ) = 



, and the first n elements of 



minimize A such that XI + R(x) > 0, subject to ^(.r) > 0. This problem is easily fea- 
sibly initialized at x = (1, 1, . . . , 1, 0, . . . , 0] 7 , such that T(ar^ 00 ^) = / > 0, and with 
A(°°) >> X max (R(x^ 00 *). Consequently, the solution of an LMI frequently required two 
passes through the interior point algorithm; the first to determine a feasible solution, 
and the second to determine the (sub)opt imal solution. 

2. Practical Observations 

The following observations were made relative to this specific implementa- 
tion of the interior point method. 



1. Much of the clamor surrounding interior point methods is due to their reputed 
dramatic increase in computational speed over other convex methods. This 
makes intuitive sense in that the method does not spend any time outside of 
the feasible set, while we found it common for 90% of the iterations of the El- 
lipsoidal methods to be spent isolating the feasible set. In practice, we found 
little difference in speed between the two methods on small problems. I am 
certain this is because of the choice of MATLAB as the programming language. 
MATLAB was chosen because that was language of the original codes provided 
by Khargonekar, and because it could be rapidly implemented for the desired 
problems. Computational speed was not as critical as speed of implementa- 
tion. With the attention the interior point methods have received in the past 
two years, translating these codes to a faster format would be unadvisable, as 
commercial codes are sure to become available shortly. 
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2. Mathematically, the interior point codes are guaranteed to stay within the fea- 
sible set due to the influence of the boundary function [Ref. 15]. This was not 
our practical experience. Two factors routinely led to the method of centers 
wandering out of the feasible set. First of all. the numerical adjustment 0 de- 
termines how close to singular the search for an analytical center is initialized. 
Mathematically, the code should converge for all 0 6 [0, 1]. In our experience, 
values much less than 0.1 resulted in the path of centers occasionally jumping 
outside the feasible set. Secondly, in a similar vein, the method should work 
if initialized at any A*°) > A mnr (/t(.r*°)). Again, if the problem was initialized 
too close to the boundary for which the LMI was singular, then path of centers 
could wander infeasible before converging to a optimum value. Consequently, 
A* 0 * was usually chosen well clear of the boundary, on the order of 0.1 or 1 greater 
A m ar( ). Furthermore, there were some problem geometries for which the 
codes were inexplicably unstable. Traps were implemented in the code in order 
to rapidly identify divergence from the feasible set, thereby slowing the general 
execution of the routines. This was done in order to alert the researcher to 
bad output, but did not correct the problem. The source of these difficulties 
is unquestionably the inherently ill-conditioned nature of these problems, their 
very intent being to puch the problem to singularity. Again, the advent of more 
robust commercial codes would hopefully mitigate these sensitivities. 

C. MATLAB FUNCTION FILES 

This section includes a listing of the interior point optimization code centers3 

and its associated subroutines. 



centers.*? 



function [xopt , lambdaopt , stat , err] =centers3( A ,B ,C , Sc , x , lambda, theta , prec , bound) 
7* Function: 

7* [xopt , lambdaopt , stat , err] =centers3( A , B ,C , Sc ,x , lambda, theta, prec , bound) 

7. 

7* Description: 

7. 

7. This function solves the problem of minimize the maximum generalized 
7. eigenvalue of the pair (A(x),B(x)) subject to a constraint C(x)>0. 

7. A(x) and B(x) are a (symmetric, symetric-posit ive-def inite) pair of 
7. matrices that depend affinely on a vector-valued variable x. 

7. 

7. Inputs: 

7. 

7. A=[A0,A1, . . . , An] , 

7. B= [BO , B1 , . . . , Bn] , 

7. C= [CO , Cl , . . . ,Cn] , axe a-matrices, that is arrays of matrices that 
7* represent an affin matrix expression depending of a vector x. 

7* Sc is a matrix representing the block structure of the restriction 

7. C(x)>0. Sc has 2 columns and the number of rows equals the number 

7* of blocks in C(x) . The first column contains the type of block 

7» (type 0 diagonal block, type 1 full block), the second column is 

7# The size of each block. . 

7. x= [xl ,x2 , . . . ,xn] ' , is an initial feasible vector. 

7. lambda is an initial value which satisfies lambda*B(x)-A(x)>0 . 

7. theta is a parameter with 0<theta<l. Typical values are close to 0. 

7. prec is the precision in computing the optimun. 

7. bound is a limit of norm(x) to detect unboundness of the 
7* problem. 

7 The affin matrix functions cam be calculated using the function affin 
7, A(x)=aff in(A,x)=A0+Al*xl+. . .+An*xn, 

7. B(x)=affin(B , x)=B0+Bl*xl+. . .+Bn*xn, 

7. C(x)=affin(C , x)=C0+Cl*xl+ . . .+Cn*xn, 

7. 

7. Outputs: 

7. 

7. xopt is the optimal vector 

7. lambdaopt is the maximum generalized eigenvalue 

7. stat is a matrix with the statistcs of the algorithm. The first column 
7. contains the iteration number, the second the number of Newton_NN 
7. iterations, and the third a bound of the error in the compute of the 
7, optimal value lambdaopt. 

7. 

7# Necessary assumptions to solve the problem: 

7. 

7. (1) The initial point is in the feasible set. 

7. (2) B is bounded away from singular on the feasible set, and we know 
7. bmin such that B(x) > bmin*I 
7. (3) The feasible set is bounded. 

7. err is an error code. If err=l the initial point is not feasible, if 
7. err=2 assumption (2) does not hold, if err=3 the problem is unbounded, 

7. in this case xopt is yet a feasible point, but norm(xopt) >= bound(l + 



194 



X norm(x) ) . 

% 

X Called functions: 

X 

X assumpl, checks assumption (1). 

X assump2, checks assumption (2). 

X assump3c, checks assumption (3), uses eigen division with Hessian 
X boundl, computes a bound of the difference between lambda and the real 
X minimal value 

X affin, computes an affin matrix function. 

X adiag, computes the a-matrix of C(x) where C(x)=diag[A(x) ,B(x)] . 

X nesnem3a, Newton algorithm to compute an analytic center . (eigen division) 
X grad2b returns barrier gradient an d hessian (structured version) 

X 

X As of 1530 on 10/12/93 this is the best performing combination so far. 

X Direct division by hessian leads to enormous increase in cputime, 

X probably because matlab does svd division when it sees an ill- 
X conditioned problem. 



•/. 

'/, Checking assumption (1) 

V. 

disp( , Method of centers. Checking initial point ...*); 
err=assumplb( A , B , C ,x , lambda) ; 
if sum(err’)<0 

disp( , Error in centers. m. Infeasible initial point’); 
disp(err ) 
return ; 

end 

V. 

*/. Checking assumption (2) 

•/. 

disp( ’Method of centers. Checking if B(x) is bounded ...’); 

[mb, nb] =size(B) ; 

if max(max(abs(B( : ,mb+l :nb) ) ) )==0, Xis B(x) constant? 
bmin=min(eig(B( : , 1 :mb) ) ) ; 
constcintb=l ; 
else , 

X bmin=assump2( A , B ,C,x , bound) ; X I THINK THIS PATH HAS A BUG! 

disp( ’non-constant b is currently disabled’) 
constantb=0 ; 

end 

if bmin<=0 

disp( 'Error in centers. m. B(x) is not bounded away of zero’); 
err=2; return; 

end 

X 

X Checking assumption (3) 

X 

disp( ’Method of centers. Checking if restriction is bounded ...’); 
[err ,x2,lambda3,Z, it 2] =assump3c( A, B,C, Sc, x, lambda, theta, bound) ; 
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if err==3 

disp('Error in centers. m. The restriction is unbounded'); 
xopt=x2 ; 

lambdaopt=lambda3 ; 
return; 

end 

% 

7, Algorithm of the centers 

7 . 

[na,ma] =size(A) ; [mz ,nz] =size(Z) ; S=[l,na;Sc]; 

it 1 = 1 ; 

cond=mz/bmin/trace(Z( 1 : na , 1 :na) ) ; 

Ax=aff in (A , x2) ; Bx=af f in(B , x2) ; 

lambda2=max (eig(Ax ,Bx) ) ; 
stat= [1 , it2 , cond,lambda2] ; 
disp(stat ) ; 

cond=l; % resets cond to force second pass through nesnem 

while (cond>prec) 
xl=x2 ; 

1 ambd a 1 = 1 ambd a 3 ; 

lambda3=( 1-theta) *lambda2+theta*lambdal ; 
if constantb==l , 

F=adiag(-A , C) ; 

F( 1 : na, 1 : na)=F( 1 : na, 1 : na)+lambda3*B( 1 : na, 1 : na) ; 

[x2,Z, it 2 ,mf] =nesnem3a(F,xl , S) ; 

Ax=af f in(A ,x2) ; 
lambda2=max(eig(Ax) ) ; 
else , 

F=adiag(lambda3*B-A,C) ; 

[x2 , Z , it 2 , mf ] =nesnem3a(F , xl , S ) ; 

Ax=af f in(A ,x2) ; Bx=af f in(B , x2) ; 

lambda2=max(eig(Ax ,Bx) ) ; 

end 

cond=mf/bmin/trace(Z(l:na, 1 :na) ) ; 
itl=it 1+1 ; 

statl=[itl , it2 , cond, leunbda2] ; 
if Iambda2>lambda3 , 

error( * centers3 blowing up') 

end 

stat= [stat ; statl] ; 
disp(stat 1) ; 

end 

xopt=x2 ; 

1 aunbdaopt = lcunbda2 ; 
tol=cond ; 

return; 

7, end centers 3 
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assumplb 



function err=assumplb( A , B , C , x , lambda) 

V. 

'/, err=assumpl (A , B , C , x , lambda) 

•/. 

*/, Description: 

'/, This function checks that the initial point for the algorithm of the 
'/, centers is admissible. 

’/. 

■/. Inputs: 

1 

'/, A a-matnx 
'/. B a-matrix 
'/, C a-matrix 

*/, x vector compatible with the a-matrices. 

'/, lambda 

•/. 

'/, Outputs : 

•/. 

*/, err is an error code, err=[0 0 0] if the initial point is admissible, err<0 
'/. otherwise. 

'/, Comments: 

•/. 

'/, See function centers 

*/. 

err= [0 0 0] ; 

zl=min(eig(lambda*af f in(B,x)-aff in (A ,x) ) ) ; 
z2=min(eig(aff in(B ,x) )) ; 
z3=min(eig(af f in(C , x) ) ) ; 
if zl<=0 

err (1 )=zl ; 

end 

if z2<=0 

err (2)=z2 ; 

end 

if z3<=0, 

err (3) =z3 ; 

end 

return ; 

*/, end assumplb 



assump2 



function bmin=assump2( A ,B , C ,x, bound) 

7 . 
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7* bmin=assump2( A , B , C , x , bound) 

7 . 

7* Description: 

*/• 

7* This function check that the restriction B(x)>0 is bounded away from 
7, be singular, it determines a lower bound bmin solving an auxiliary 
7. minimization problem. If B(x)=B constant matrix, bmin is the minimum 
7. eigenvalue of B. 

7. 

7* Inputs : 

7. 

7# A a-matrix, 

7* B a-matrix , 

7. C a-raatrix, 

7* x vector, 

7* bound is a bound to detect that C(x) is unbounded. 

7. 

7. Outputs : 

7. 

7. bmin is a bound for B(x) 

7. 

7* Comments: 

7. 

7. See function centers 

7. 

7. 

[na ,ma] =size ( A) ; 

7. 

7* If B(x) is a function of x 

7. 

if B( : ,na+l :ma) '=zeros(na,ma-na) 

Al=-B ; 

A2=aident (size(Al ) ) ; 
lambda=max(eig(af f in(Al ,x) ) )+l ; 

[xlopt ,b , st at , err] =c enters ( A1 , A2 , C , Sc , x , lambda , theta ,prec , bound) ; 
if err==0 
bmin=-b ; 
else 

error(’Error checking assumption (2)'); 

end 

7. 

7* If B(x)=B constant matrix 
7. 

else 

bmin=min(eig(B( : , 1 :na) ) ) ; 

end 

return ; 



assump3c 
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function [err , xnew , lnew , Z , it] =assump3c ( A , B , C , Sc , x , lambda, theta, bound) 

V. 

'/, [err , xnew , lnew ,Z , it] =assump3b(A , B , C ,Sc , x , lambda , theta, bound) 

% 

V, This function checks assumption (3) of the method of centers using 
'/, one iteration of the centers method, if the norm of x diverges, then 
'/. an unbounded direction exists. It returns the analytic center x, the 
*/, value of the maximum eigenvalue lnew, and an error code which is err=3 
'/. if the problem is unbounded and err=0 otherwise. 

y. 

'/, Inputs: 

y. 

'/, A , B , C a-matrices. 

•/, Sc matrix with the block structure of C(x) 

'/, x vector 

'/, lambda initial value 

'/, theta parameter of the method of centers. 

'/, bound is a limit for the norm of x to detect divergence. 

y. 

'/, Outputs: 

y. 

•/, err error code. err=3 if the problem is unbounded, otherwise err=0. 

*/. xnew analytic center. 

'/, lnew new value of lambda for xnew 
*/. Z=inv (F (x ) ) 

*/, it is the number of iterations 

y. 

*/. Comments: 

y. 

•/, See function centers. 

'/, Modified to call grad2b, uses eigen division 

[na ,ma] =size(A) ; 

Ax=af f in(A ,x) ; 

Bx=aff in(B,x) ; 

lambda l=max(real(eig( Ax , Bx) ) ) ; 
lnew=( 1 -theta) *lambdal+ theta* lambda ; 

F=adiag(lnew^B-A ,C) ; 

S= [1 ,na;Sc] ; 

x2=x; delta2=l; it=0; 

while ( (delta2>0. 001 )& (norm (x2)<bound) ) 
xl=x2 ; 

deltal=delta2 ; 

[g,H,Fx,mf]=grad2b(F,xl ,S) ; 

[uH ,dH] =eig(H) ; 
if any (diag(dH)==0) , 

error ( ’Hessian collapsed trying to analyze assump3’), 

end 

Hg=uH^ (diag(dH) .\(uH**g)) ; 
delta2=sqrt (g 1 *Hg) ; 
if delta2 > .25 
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alpha=l/( l+delta2) ; 
else 

alpha=l ; 

end 

x2=xl-alpha*Hg; 
it=it+l ; 

end 

[uF , eF] =eig(Fx) ; 

Z=uF* ( eF\uF 1 ) ; 
if any (diag(eF)<0) 

errorC'Fx is not positive definite in assump3c’) 

end 

xnev=x2 ; 

Fx2=af f in(F, x2) ; 
if any (eig(Fx2)<=0) 

disp( terminal point in assump3c infeasible- reverted to previous’) 
xnew=xl ; 

end 

if norm(x2)>bound 
err=3 ; 
else 

err=0 ; 

end 

return ; 

'/, end assump3c 



affin 



function F = af f in( A , x , col) 

V. 

*/, F = aff in(A,x, col) 

% 

7, Description: 

*/• 

*/, This function computes the affine matrix expression 

'/. F = AO + A1 xl + ... + Ar xr. If A is an empty a-matrix, 

'/, the function returns F= [] . 

•/. 

*/, Inputs: 

*/• 

'/, A is an a-matrix A= [AO , A1 , . . . , Ar] , 

*/. x is a vector x= [xl , . . . , xr] . 

'/, col is the number of columns of A, if not provided, it is assumed 
*/. equal to the niimber of rows. 

y. 

*/* Outputs: 

y. 

'/, F is the matrix F = AO + A1 xl + ... + Ar xr. 

y. 
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if A== [] 

F=[] ; 
return ; 
else 

[ma,na] =size( A) ; 

[mx,nx]=size(x) ; 
if nargin==2 
col=ma; 

end 

n=na/col; '/. number of matrices in A 

if n“=max(mx ,nx)+l 

error(’Error in affin.m. Incompatible dimensions’) 

end 

F=A ( : , 1 : col) ; 
for i=l : n-1 
j=col*i ; 

F=F+A ( : , j+1: j+col)*x(i) ; 

end 

end 

return ; 



acliag 



function F=adiag(B,C) 

*/♦ given the a-matrices B and C, finds the a-matnx F such that 
*/, af f in(F ,x)= [af f in(B ,x) ,0; 0, affin(C,x)] 

V. 

*/. calls daug from mutools 

[nb,mb] =size(B) ; [nc,mc] =size(C) ; 
dim=mb/nb ; 

F= [] ; 

for i=0:dim-l, 

kl=i*nb; k2=i*nc; 

F= [F,daug(B( : ,kl+l :kl+nb) , C( : ,k2+l : k2+nc) )] ; 

end 

*/. end adiag 



nesnem3a 

function [xopt , Z , iter ,mf ] =nesnem3a(F ,x , S) 

X 

*/. [xopt , Z , iter] =nesnem3(F , x , S) 
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7, Description: 

7. 

7. This function determines the analytic center 'xopt* which minimizes 
7. the barrier function f(x)=log det inv(F(x)) using Nesterov and 
7, Nemirovsky’s Newton algorithm, where F(x)=F0+Fl*xl+ . . . +Fr*xr . 

7. 

7. Inputs : 

7. 

7. F = [FO ,F1 , . . . , Fn] , 

7. x = [xl,...,xn], is a initial value, 

7. 

7. Outputs: 

7. 

7. xopt analytic center 

7. Z=inv(F(x)) which will be used later in the stopping criteria 
7. for the method of the centers, actually is calculated in function 
7. "grad” . 

7. iter number of iteration to find the analytic center. 

7. 

7. Related functions: 

7. 

7. grad2b computes gradient and hessian of f(x) = log det inv(F(x)). 

7. 

7# Comments: 

7. Called by centers. 

7. 

7. This version uses eigen decomposition for ill-conditioned divide. Computes Z out of loop 

xl=x; iter=0; delta=l; 

while (delta> . 001 ) 

[g,H,Fx,mf]=grad2b(F,xl ,S) ; 7. Determination of gradient and hessian 

[uH ,dH] =eig(H) ; 
if any (diag(dH) ==0) , 

disp( 'Hessian collapsed*) , 
break 

end 

Hg=uH*(diag(dH) A(uH»*g)) ; 

delta=sqrt(g'*Hg) ; 7. Newton decrement 

if delta > .25 

alpha=l/ ( 1+delta) ; 
else 

alpha=l ; 

end 

xl=xl-alpha*Hg ; 
iter=iter+l ; 

end 

xopt=xl; Z=inv(Fx); 

return ; 

7. end nesnem3a 
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grad 2b 



function [g , H, Fx , mf] = grad2b(F , x , S) 

*/. 

*/. [g, H, Fx] = grad2(F,x,S) 

*/. 

*/, Description: 

y. 

*/, This function determines the gradient , g’ and the hessian 
*/, of the barrier function f(x) = log det inv(F(x)), 

*/. gi(x)=-Trace (ZFi) , i=l,...,n, 

*/, Hij (x)=Trace(ZFi) (ZFj ) , i=l,...,n, 

'/. Z=inv(F(x) ) 

y. 

'/, Inputs : 

y. 

y. F = CFO, FI , . . . ,Fn] , 

*/. x = [xl , . . . ,xn] , 

'/ S is the block structure of F(x), S=[sl s2] , where si is a vector 
Z with the type of block (type=0 is a diagonal block, type=l is a full 

*/, order block), s2 is a vector with the size of each block. If does not 

*/, exist matrix S, it is supposed that F(x) is a complete full order 
*/, block. 

y. 

*/, Outputs: 

y. 

*/• g gradient 
*/, H hessian 
y. Fx= F(x) 

•/. 

*/, This version differs from the original by taking advantage 

*/, of MATLAB4 J s smart division, and differs from grad2 by exploiting 

*/, structure. 

*/, Significant flops are saved by taking advantage of the structure 
'/, of the argument of the trace in computing the hessian. 

*/* Block division is desirable since we're forcing an ill-conditioned 
'/, problem, and the smaller the blocks, the more accurate the division 
*/♦ will be. F(x) should be PD, so matlab4 will use cholesky as long as 
*/, the subblocks of F(x) remain numerically PD. 

•/. 

y. Comments: 

y. 

X See functions nesnem and centers. 

y. 

[mf , nf] =size(F) ; 
if nargin==2, 

S= [1 ,mf ] ; 

end 

[ms ,ns] =size(S) ; 
dim=nf /mf-1 ; 

Fx=af f in(F , x) ; 
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H=zeros (dim,dim) ; 



indl=l ; 



g=zeros(dim, 1 ) ; 
for j=l : ms , 

if (S ( j , 1 ) ==0 ) | (S( j , 2)==1) , 
for i=l : S ( j ,2) , 

FxF=Fx(indl , indl)\F(indl , indl+mf :mf : indl+dim*mf) ; 
g=g-FxF’; 

H=H+FxF'*FxF; 
indl=indl+l ; 

end 
else , 

size=S(j,2); kl=indl : indl- 1+size ; k2=zeros ( 1 , size*dim) 

for i=l:dim, 

k2( l+(i-l )*size : i*size)=kl+i*mf ; 

end 

FxF=Fx (kl ,kl)\F(kl ,k2); 
for i= 1 : dim , 

ll=FxF( : , size*(i-l)+l : size*(i-l )+size) ; 
g(i)=g(i) -trace (11) ; 

H(i,i)=H(i, i)+sum(sum(ll . *11 1 ) ) ; 
for k=i+l :dira, 

12=FxF( : , size* (k- 1 ) +1 : s ize* (k-1 ) +size ) ; 

H(i,k)=H(i ,k) + sum(sum(ll .*120) ; • 

H(k , i)=H( i , k) ; 

end 

end 

indl=indl+size ; 

end 

end 

return; 

7. end grad2 
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APPENDIX D:PLANT/CONTROLLER 
OPTIMIZATION CODES 



This appendix documents the MATLAB script and function files which were 
used in solving the example problems discussed in Chapter V. The first section is the 
function files which perform the optimization. These functions are independent of 
the specific example to be solved, but instead solve a general class of problem, such 
as the joint pole placement problem. The second section is the scripts which 
were used to prepare the synthesis models for the example problems. The outputs of 
these scripts were used as the input arguments for the optimization functions in the 
first section. 

A. PLANT/CONTROLLER OPTIMIZATION FUNCTIONS 

This section documents the function files which perform the plant controller 
optimization process. These functions all had similar struct lire, and input and output 
arguments. The input arguments included the synthesis model, initial plant and cost 
vector , and the optimal plant and associated controller were outputs. The synthesis 
models were required to be state-space representations of the plants with A , B\ and 
/?2 expressed as u a-matrices” of the associated plant variables. That is if: 

r 

A — -4(0 = + £CO,. 

i=i 

b , = = + 

1=1 

b 2 = tf(0 = fi 2o + £c,fi 2,, 

«=i 
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then the associated a-matrices were Aa= [Ao, A \ , . . . , /t r ], Bla= [B ]o , B\ l , . . . , /i lr ], 
and B2a= [B 2o , # 2 j , • . . , B 2r ]. The matrices Aa, Bla, and B2a are then the bases for 
the plant matrices A,B\, and B 2 . 

Per Chapter V, the general met hod was to first find a feasible controller which 
minimized the controller margin for the initial plant (maximized its absolute value), 
then freeze the controller while minimizing the cost function J = c T (. Both the 
controller optimization and the plant optimization were performed using the interior 
point function centers3 documented in Appendix C. 

The first plant optimization code (plantopt2), which employs a single 
constraint, provided the baseline structure for all that followed. Consequently, in the 
interest of volume, this code alone is thoroughly documented. 

1. Plant and Controller Optimization for an Hr*, Performance Con- 
straint 

The function plantopt2 and its associated subroutines solves the plant/ 
controller optimization problem with a pure 7 performance constraint. From 
Chapter V, the general method revolves about two EVP’s. Algorithmically: 

1. Evaluate A(C),#i(0 ' anc ' ^(0* 

2. Determine 7Yoo feasibility for the initial, and find a particular solution (W p , Y p ) 
to the Riccati 'H co analysis equation. 

3. Create a basis Z for the controller variables M\ and V . 

4. Find the vector f which maps Z to (W p , V p ). 

5. iter Using A(C),Z?i(C) , and B 2 ( C), an( l the basis Z, find the basis for the 

Tioo LMI, equation 5.2. 
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6. Find a feasible initial eigenvalue A 0 for the inequality A 0 / — //](£) > 0. 

7. Use the method of centers to find a controller (represented by a new f ) which 

satisfies the LMI: 

Minimize: A (over £), 

Subject to: 



A/-/MCO 0 
o V(0 



> 0 . 



(I). 



Note that A must be negative for the problem to be feasible. 



8. Verify that A represents a feasible solution, or that A is not so small as to satisfy 
the termination criteria. 



9. Evaluate IV(£),V(£). 



10. Using W and Y and the plant bases matrices Aa, B\a and B 2a, find a basis for 
the alternate 7Yoo LMI (equation 5.3). 



11. Now optimize the plant cost J = c 7 subject to the 7 constraint, and the 
constraint that the plant variables must have positive value: 

Minimize: J (over £), 

Subject to: 



" J - c r C 0 0 

0 diag(C) 0 

0 0 -fl 2 (C,0 

12. Evaluate the new plant A{C)<, B\(C) ' ail( l ^(0* 



> 0 . 



(D.2) 



13. Co to step iter until exit criteria is satisfied. 



The progress of this algorithm is supported by a number of subroutines. 
Feasibility is tested by Riccati solvers from the ft - Tools toolbox to determine an 
initial feasible solution. Note that this particular solution is not precisely feasible in 



the since of the LMI’s, since it represents the solution of a Riccati equality rather 
than inequality. The inequality will he enforced the first pass through the algorithm, 
and the Riccati solution being “close” to a solution of the inequality dramatically 
reduced the computational workload on the first pass. From the plant and a-matrices 
for the controller variables, the basis matrices for the constraint functional on £ are 
constructed by the subroutine hinfres6. The interior point algorithm, centers3, 
then finds a controller that minimizes the controller margin. The controller margin 
must be negative for the controller to be considered feasible and for the algorithm to 
proceed. Furthermore, if the absolute value of the controller margin is less than some 
small numerical threshold (typically I0“ 6 to lO -10 ), then the feasible set is too small 
practically to proceed, and the loop is exited. This is the usual exit path. If these 
criterion are satisfied, the code proceeds to the plant optimization phase. Using the 
above controller, the function hinf res4 builds the basis matrices for the constraint 
functional on (. The interior point code is then called again to optimize the plant 
cost (over £). The loop can also be exited at this point if the cost does not decrease 
from iteration to iteration, or if the maximum iteration count has been reached. If 
the cost has been successfully decreased, then the algorithm returns to the controller 
design phase to find a new controller. The optimal plant, controller, and algorithm 
history are returned as outputs. The other called subroutines are administrative, and 
are described in Appendix C. 



plantopt‘2 



function 



[zeta,xi,K,Z,Rc,Tc,J2,err]=. . . 

plantopt2(Aa,Bla,B2a,C,D ,zet a, weight ,thres ,gam, theta, prec) 



*/, [zeta,xi,K,Z,Rc,Tc, J2, err] =plantopt2(Aa,B la, B2a,C,D,zet a, weight ,thres, gam, theta, prec) 
% [zeta, xi , K ,Z , Rc ,Tc , J2 , err] =plantopt2(Aa,Bla,B2a,C,D ,zeta, weight ,thres) 
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y. 

V, Description: 

V# Given: 

'/, xdot = A x + B1 w + B2 u, 

*/, z = C x + Du, 

y. y = X, 

y. 

*/, This function determines the minimum state-feedback plant satisfying 
*/. I lT_zvl Linfty < gamma 

y. 

'/, min J=weight*zeta 
y. subject to: 

•/. 

•/. R(Z)=AY+YA'+B2V +W > B2 ' +B1B 1 ' + (CY +DV)' (CY +DW)< 0, 

y. 

'/, Code alternatively finds central controller, and minimizing plant 
'/, using the method of centers to solve equivalent LMI’s. 

y. 

y* Inputs: 

y. 

'/« C,D are constant matrices from the state-space realization of the system. 

'/. Aa, Bla and B2a are a-matrices which hold the affine elements 

*/, zeta is the vector that defines the initial plant ( A=af f in( AA , zeta) ) 

'/. weight is the row vector of weights in the objective function 
*/, thres is the threshold on the central controller margin 
*/, for determining when to quit the iterative procedure 

'/. gam is a bound of the H-inf norm for the closed loop system, 
y. theta parameter of the method of centers 

*/, prec is used by the method of centers to determine when to quit the newton 
'/, search for the analytic center. The default is 0.001, bur if the ricatti 

*/, soln indicates that the problem is feasible and yet the method of centers 

cannot find a solution, then this parameter should be adjusted to something 
'/, smaller to allow the newton search to go deeper. 

'/, If the ricatti solvers indicate that the problem is feasible and yet the 

y, method of centers cannot find a feasible controller, then this parameter 

'/, should be set smaller. 

y. 

'/, Outputs : 

y. 

'/, z is the optimized vector of plant parameters 

'/, xi is the vector of controller parameters 

'/, K the state-feedback gain matrix 

*/, Z is the basis for the controller matrices W,Y 

y, Rc , Tc are the bases for the controller and plant optimization constraints 
*/, J2 is the history of the problem 
'/, err is an error flag 

y. 



'/. Called functions: 

'/, basis, computes a basis for a set of block structured matrices 
'/, hinfres, computes the a-matrix of a Riccati inequality restriction 
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7. adiag, computes the a-matrix of diag(A(x) , B(x) ) 

7. atrace, computes the a-matrix of trace (R,X) 

7. aident, gives an a-raatrix with the indept . term equals unity and 
7. the rest of matrices zeros. 

7. getvec, gives the realization of a matrix in a matrix basis. 

7. affin, computes an affin matrix function. 

7. 

7. Comments : 

7. 

7. The assumptions for this function are standard in the state-feedback 
7. Hinf case, (A,B1) stabilizable and D1 has full column rank. 

7. These assumptions are not checked, though they probably should be. 

7. If the inputs gam, prec and theta are not provided, they are initialized 
7. to 1, 0.1 and 0.001 respectively. 

if nargin<ll 

gam=l ; theta=0.1; prec=.001; 

if nargin==7, 
thres=le-6 

end 

end 

[ma ,na] =size (Aa) ; dimz=na/ma; 

[mbl , nbl]=size(Bla) ; nql=nbl/dimz ; 

[mb2 ,nb2]=size(B2a) ; nq2=nb2/dimz ; 

[me ,nc] =size(C) ; 

7. Determine initial plaint 

A=af f in(Aa , zeta) ; Bl=af f in(Bla , zeta ,nql ) ; B2=af f in(B2a , zeta , nq2) ; 

7. Determine hinf feasibility/central controller 
7. by solving hinf synthesis hamiltonian 
a=A-B2*( (D'*D)\D')*C; 

ham= [a , ((B1*B1 1 /ganT2)-B2*( (D * *D)\B2 1 ) ) ; -C ' * (eye(mc)-D*( (D ’ *D)\D » ) ) *C, -a»] 
[xl , x2 ,f ail] =ric_schr (haun ) ; Xinf=x2/xl ; 

if (fail>0) I any (eig(Xinf )<0) , 

disp( ’ Initial System appears inf easible-1 ’ ) ; return 
else 

disp( ' Initial Hinf problem feasible') 

end 

Kp=- (D ' *D)\(D ' *C+B2 ' *Xinf ) ; 7. '‘central" controller 

7. Determine particular soln from central controller 
7. by solving hinf analysis hamiltonian 

al=A+B2*Kp; bl= [B 1 , 10000*sqrt(eps )*eye(ma)] ; cl=C+D*Kp; 

[xl , x2 , f ail] =ric_schr ( [al * , cl * *cl ; -bl*bl * ,-al] ) ; Yp=x2/xl ; 

if (fail>0) I any (eig(Yp)<0) , 

disp( ’ Initial System appears inf easible-2 ' ) ; return 

end 

Wp=Kp*Yp ; 
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y. 



7. Initializing the optimization 

y. 

[Z , YY ,dimz] =basis2(ma ,nq2) ; 
xi=getvec2( [Yp; Wp] ,Z) ; 

Syy= [l ,ma] ; 

Rb=eye(ma+mc , (dimz+1 ) * (ma+rac ) ) ; 
Rc= [zeros (ma ,ma) , YY] ; 

Ta= [0 , weight] ; 

Tb=eye( 1 , length (Ta) ) ; 
J=weight*zeta ; 
lam=-l ; 

J2-[]; iteration^; 

CD= [C D] ; 



'/. simplifies argument 



'/, builds the basis Z for W,Y 

*/• get initial xi from initial controller 

'/. establishes the structure of Y 

'/, est. basis for controler EVP 



*/. est. basis for plant EVP 



while lam<-le-12, 



iterations ter at ion+1 



y. 



*/, For fixed plant- find the optimal controller (best controller margin) 



disp( ' searching for new controller') 

'/, create the basis for the hinf constraint 
[Ra , Sc2] =hinf res6( [A B2] , CD , B1 *B1 * , gam , Z ) ; 

'/, determine initial lambda for EVP and add some slop to make it feasible 
'/. this takes care of changing the equality above to inequality 
lamin=max(eig(af f in(Ra, xi) ) ) + 0.1; 

V, find the set of controller parameters 'xi* which minimize the 
'/, controller margin 'lam* 

[xiop , lam, st at , err 2] =c enter s3(Ra , Rb , Rc ,Syy ,xi , lam in, theta ,prec , lel2 ) ; 

if err2"=0 , 

err=3; return; 

'/, terminate if centers couldn't find a feasible controller (lam>=0), 

'/, or the margin was too small to bother proceeding (lam>-thres) 
elseif lam>=0, */, feasibility criteria 

disp( ' centers could not find a new feasible controller’) 
break 

elseif lam>-thres, */, termination criteria 

disp( 'feasible set too small to proceed') 

break 



y. 



end 



V. build new controller W,Y from xi 
YW=affin( [zeros (ma+nq2 ,ma) ,Z] ,xiop,ma) ; 
Y=YW( 1 :ma , : ) ; W=YW(ma+l :ma+nq2 , : ) ; 
xi=xiop ; 



K=W/Y ; 



% 

'/, Fix controller- solve the min airframe problem 

V. 

disp( Optimizing plant for previous controller 1 ) 

•/. using the controller above, find the basis for hinf restriction 
[Tc ,Sc] =hinfres4(Aa,Bla,B2a, YW , CD, gam) ; 

7, add some padding to previous optimum cost to make problem very feasible 
J=J+ . 1 ; 



*/, optimize the plant 

[zetaop , J , stat , err2] =centers3(Ta,Tb,Tc ,Sc ,zeta, J , theta ,prec , lel2) ; 
if err2~=0 
err=3 ; 
return; 

end 

zeta=zetaop ; 

*/, Build the new plant 

A=aff in(Aa ,zeta) ; Bl=af f in(Bla , zeta ,nql ) ; B2=af f in(B2a ,zeta,nq2) ; 

disp( [lam, J] ) 

*/, Stack the data for output history 
J2=[J2; lam, J, zeta*]; 
disp(’Closed Loop Poles=’) 

E=eig( A+B2*K) ; disp(E’) 

if any(real(E)>=0) , 
err=4 ; 
return 

end 

*/, alternate termination criteria (this is only a back-up to above) 
if iteration>2, 

if (J==J2( iteration-1 , 2) ) | iteration==100 , 
break 

end 

end 



end 

'/, Determine the controller 

Y=YW( 1 :ma, :); 

W=YW(ma+l :ma+nq2, : ) ; 

K=W/Y ; 

•/. plot the optimization history 

loglog(-J2( :, 1) ,J2( : ,2) , **'), grid, title( ’Plant Cost vs. Controller Margin’) 
xlabel( ’Controller Margin ’) ,ylabel( ’Plant Cost’) 
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err=0 ; 
return; 

X end plantopt2 



hinfresG 



function [F,Sf] =hinf res6(AB , CD , BIB 1 ,gam,Z) 

X 

X [F , Sf ] =hinf res6(AB , CD ,B1B1 , gam,Z) 

X 

X Description: 

X 

'/, This function determines the a-matrix of the convex restriction 

X 

X I AB*YW + (AB*YV)> + B1B1 (CD*YW) ’ | 

X R(Z) =1 2 I < 0, 

% I CD*YV -gam I I 

X 

X 

y. Inputs: 

X 

'/, AB , CD , B1B1 ,gam parameters of the restriction 
X Z basis for YW from basis2 

X 

X Outputs: 

X 

X F a-matnx of the restriction 
X Sf block structure of F 

X 

X Comments: 

X 

X Note that in order to obtain the value of the restriction, we need a 
X vector x= [xl , . . . , xr] , then F(x )=F0+Fl*xl+ . . .Fr*xr , the block structure 
X of F(x) is Sf. 

X 

X this basis uses the reduced order problem 

[mz ,nz] =size(Z) ; 

[mm,nm]=size(AB) ; 

[mr ,nr] =size(CD) ; 

[ms ,ns] = size (BIB 1 ) ; 

dim=nz/mm; mmr=mm+mr; 

F=zeros (mmr ,mmr*dim) ; 

F( : , 1 :mmr) = [B1B1 , zeros (mm ,mr) ;zeros(mr ,mm) , -gam*gam*eye(mr )] ; 

F3=zeros (mr ) ; 
for i=l:dim, 

YW=Z( : , (i-1 ) *mm+l : (i- l)*mm+mm) ; 

F1=AB*YW ; F2=CD*YW; 
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F( : , i*mmr+l : ( i+1 )*ramr )= [Fl+Fl * ,F2 ' ; F2 , F3] ; 

end 

Sf = [1 ,mm+mr] ; 
return; 

'/, end hinfres6 



hinfres4 



function [R,Sf]=hinfres4(Aa,Bla,B2a,YW,CD ,gam) 

7 . 

y. [R >Sf ] =hinf res4( Aa , Bla,B2a, YW ,CD ,gam) 

y. 



*/. Description: 

y. 

*/, This function determines the a-matrix of the convex restriction 

y. 

*/. I AY+B2W+YA , +W , B2 , + (CY+DW) » (CY+DW) B1 I 

'/. R(zeta) =1 ' I < 0, 

y. I B1 * - eye I 

•/, 

•/. 

*/. Inputs : 

y. 

*/. Aa,Bla,B2a are a-matrices of the plant 

*/, YW,CD,gam parameters of the restriction (YW is the packed form [Y ; W] ) 

y. 

*/, Outputs : 

7 . 

*/, R a-matrix of the restriction (-R>0 is actually returned) 

*/, Sf block structure of R 

•/. 



*/, Comments: 

*/. 



*/, Note that in order to obtain the value of the restriction, we need a 
*/, vector x= [xl , . . . , xr] , then R(x)=R0+Rl*xl + . . .Rr*xr, the block structure 
*/, of R(x) is Sf . 

y. 



[ma,na] =size(Aa) ; 

[mbl ,nbl] =size(Bla) ; 

[mb2 ,nb2] =size(B2a) ; 
dimz=dim-l ; 

Fl= [Aa( : , 1 : ma) , B2a( : , 1 : nq2)] *YV ; 
CYDW=CD*YW/gam; 

R=zeros(il ,dim*(il) ) ; 

R(dim:il ,dim: il)=- [Fl+Fl ’+CYDV2 , 
for i=l:dimz, 



dim=na/ma; 
nql=nbl/dim; 
nq2=nb2/dim; 
il=dimz+ma+nql ; 

CYDW2= CYDW * *CYDW ; 

F3=zeros(nql ) ; 

Bla( : , 1 : nql ); Bla(:,l:nql)’ ,-eye(nql )] ; 



R( i , i+il*i)=l ; 
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F 1 = [Aa ( : , i*ma+l : i*ma+ma) , B2a( : , i*nq2+l : i*nq2+nq2)] *YV; 
F2=Bla( : , i*nql+l : i*nql+nql ) ; 

R(dim:il,(i*il+dim):(i*il+il))=-[Fl+Fl , ,F2;F2’ ,F3] ; 

end 

Sf= [zeros (dimz , 1) , ones (dimz, 1) ; 1 , ma+nql] ; 
return ; 

•/• end hinfres4 



2. Plant and Controller Optimization for an 7irx> Performance Con- 
straint at Multiple Flight Conditions 

The function plantopt5 solved the multiple flight condition problem. It 
called the identical subroutines as plantopt2 above, and differed only slightly in 
structure. During the first phase three independent controllers were calculated for 
the three respective flight conditions. The second phase then stacked the constraint 
functionals so as to jointly perform the plant optimization. The subroutine adiag 
performed the administrative task of stacking a-matrices for the imposition of joint 
constraints, and is documented in Appendix (\ 



plantopt5 



function [zeta,xil,xi2,xi3,Z,J2, err] =. . . 

plantopt5(Aa,Bla,B2a, Aa2,Bla2 , B2a2 , Aa3, Bla3 , B2a3 , C ,D , zeta , weight , gam , theta ,prec) 

y. 

*/. [K , val, err] =h2hinf sf (Aa,Bl a , B2a,C,D , zeta, weight ,gam , theta, prec) 

*/♦ [K , val, err] =h2hinf sf (Aa, B1 a , B2a, C,D, zeta, weight ,gam) 

7 . 

*/. Description: 

*/. Given: 

*/. xdot = Ax+Blw+B2u, 
y, z = C x + Du, 

*/. y = x , 

7 . 

*/, This function determines the minimum statef eedback plant satisfying 
*/. I |T_zw | | _inf ty < gamma 
*/, min J=veight 1 *zeta 
*/, subject to 

y. 



*/, R(Z)=AY+YA'+B2V +W » B2 • + B1B1 ' + (CY +DW) * (CY +DW)< 0, 

•/. 

*/• Code alternatively finds controller, and minimizing plant 
'/, using the method of centers. 

•/. 

% THIS CODE IS THE ANALOG TO PLANT0PT2 AND 
*/. FINDS THE SIMULTANEOUS OPTIMUM FOR 
*/. MULTIPLE FLIGHT CONDITIONS 

y. 

'/, Inputs: 

*/• 

*/, C,D are constant matrices from the state-space realization of the system. 

*/, Aa, Bla and B2a are a-matrices which hold the affine elements 

*/. zeta is the vector that defines the initial plant (A=af f in( AA , zeta) ) 

'/, weight is the row vector of weights in the objective function 
'/. gam is a bound of the H-inf norm for the closed loop system. 

'/, theta parameter of the method of centers 

*/, prec precision in the compute of the upper bound of the H2 norm. 

•/. 

*/. Outputs: 

y. 

'/. K the gain 

*/, val the optimum value of the performance index computed by centers 
*/. algorithm 

'/. err error code, its value is err=l if the problem is infeasible, 

'/. otherwise err=0. 

% Called functions: 

*/. basis, computes a basis for a set of block structured matrices 
*/. hinfres, computes the a-matrix of a Riccati inequality restriction 
*/. adiag, computes the a-matrix of diag(A(x) , B(x) ) 

'/. atrace, computes the a-matrix of trace(R,X) 

*/• aident , gives an a-matrix with the indept. term equals unity and 
*/. the rest of matrices zeros. 

*/. getvec, gives the realization of a matrix in a matrix basis, 
y. affin, computes an affin matrix function. 

y. 

*/, Comments : 

V. 

*/. The assumptions for this function are standard in the state-feedback 
*/, Hinf case, (A,B1) stabilizable and D1 has full column rank. 

*/. These assumptions are not checked, though they probably should be. 

*/. If the inputs prec and theta are not provided, they are initialized 
'/• to 0.1 and 0.001 respectively, 
if nargin==8 

theta=0.1; prec=.001; 

end 

[ma,na] =size(Aa) ; dimz=na/ma; 

[mbl ,nbl] = size (Bla) ; nql=nbl/dimz ; 

[mb2 ,nb2] =size(B2a) ; nq2=nb2/dimz ; 

[me ,nc] =size(C) ; 



216 



'/, Flight Condition 1 

'/. Determine f easibility/controller 

A=af f in(Aa,zeta) ; Bl=affin(Bla,zeta ( nql); B2=af f in(B2a,zeta,nq2) ; 

a=A-B2*((D , *D)\D , )*C; 

ham=[a, ( (B1*B1 * /gam~2)-B2*( (D * *D)\B2 > ) ) ; -C’*(eye(mc)-D*( (D’*D)\D’ ) )*C, -a']; 
[xl ,x2 , f ail] =ric_schr (ham) ; Xinf =x2/xl ; 

if (fail>0) | any ( eig(Xinf ) <0) , 

disp( 1 Initial System appears inf easible-1 1 ) ; return 
else 

disp( * Initial Hinf problem feasible') 

end 

Kp=-(D * *D)\(D * *C+B2 * *Xinf ) ; 7* controller 



7, Determine particular soln from controller 

al=A+B2*Kp; bl = [B 1 . 10000*sqrt(eps)*eye(ma)] ; cl=C+D*Kp; 

[xl ,x2 , fail] =ric_schr ( [al • , cl ’ *cl ; -bl*bl * ,-al] ) ; Ypl=x2/xl ; 

if (fail>0) | any (eig(Ypl )<0) , 

disp( * Initial System appears inf easible-2 * ) ; return 

end 

Wpl=Kp*Ypl ; 



V, Flight Condition 2 

'/♦ Determine feasibility/controller 

A2=af f in( Aa2 ,zeta) ; B12=aff in(Bla2 ,zeta,nql ) ; B22=af f in(B2a2 ,zeta,nq2) ; 

a=A2-B22*((D’*D)\D’ )*C; 

ham= [a, ( (B12 + B12 * /gam“2)-B22* ( (D ’ *D)\B22 » ) ) ; -C * * ( eye(mc)-D* ( (D 1 *D)\D * ) )*C , -a ’] 
[xl ,x2 ,f ail] =ric_schr (ham) ; Xinf =x2/xl ; 

if (fail>0) I any (eig(Xinf )<0) , 

disp( 1 Initial System appears inf easible-1 * ) ; return 
else 

disp ( 9 Initial Hinf problem feasible’) 

end 

Kp=- (D ’ *D)\(D ’ *C+B22 * *Xinf ) ; 7. controller 



'/♦ Determine particular soln from controller 

al=A2+B22*Kp ; bl = [Bl2 , 10000*sqrt (eps)*eye(ma)] ; cl=C+D*Kp; 

[xl ,x2 ,f ail] =ric_schr ( [al 1 ,cl * *cl ; -bl*bl * , -al] ) ; Yp2=x2/xl ; 

if (fail>0) | any (eig( Yp2)<0) f 

disp( 1 Initial System appears inf easible-2 ’) ; return 

end 

Wp2=Kp* Yp2 ; 

l Flight Condition 3 

7. Determine feasibility/controller 

A3=aff in(Aa3 ,zeta) ; B13=aff in(Bla3,zeta,nql) ; B23=af f in(B2a3 ,zeta,nq2) ; 

a=A3-B23*((D , *D)\D l )*C; 

ham=[a, ( (B13*B13 » /ganT2)-B23* ( (D ’ *D)\B23 » ) ) ; -C ’ * ( eye(mc)-D* ( (D ’ *D)\D * ) )*C , -a ’] 
[xl ,x2 ,f ail] =ric_schr (ham) ; Xinf =x2/xl ; 

if (fail>0) | any (eig(Xinf )<0) , 

disp( * Initial System appears inf easible-1 *) ; return 
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else 

disp( ’ Initial Hinf problem feasible') 

end 

Kp=- (D’*D)\(D , *C+B2' *Xinf ) ; V. controller 
*/, Determine particular: soln from controller 

al=A3+B23*Kp; bl= [B13 , 10000*sqrt (eps)*eye(ma)] ; cl=C+D*Kp; 

[xl , x2 ,f ail] =ric_schr ( [al * , cl ' *cl ; -bl*bl * ,-al] ) ; Yp3=x2/xl ; 

if (fail>0) I any (eig(Yp3)<0) , 

disp( 1 Initial System appears inf easible-2 * ) ; return 

end 

Wp3=Kp*Yp3 ; 

y. 

'/, Initializing the optimization 

7 . 

[Z,YY,dimz] =basis2(ma,nq2) ; 

Rb=eye(ma+mc , (dimz+1 ) * (ma+mc) ) ; 

CD= [C D] ; 

Ta=[0, weight]; 

J=weight*zeta; 
xil=getvec2 ( [Ypl ; Wpl] ,Z) ; 
xi2=getvec2 ( [Yp2;Wp2] ,Z) ; 
xi3=getvec2( [Yp3;Wp3] ,Z) ; 

while lam<-le-12, 

iteration=iterat ion+1 

*/. 

'/• defining/solving the controller problem-fit cond 1 

7 . 

disp( ' searching for new controller- fit cond 1’) 

[Ra,Sc2]=hinfres6( [A B2] , CD ,B1*B1 ' , gam,Z) ; 
lamin=max(eig(af f in(Ra, xil) ) ) + 0.1; 

[xiop, laml , stat , err2] =centers3b(Ra, Rb, Rc , Syy ,xil , lamin , theta ,prec , lel2) 
if err2~=0, 

err =3; return; 

elseif lam>=0, 

disp( * centers could not find a new feasible controller') 
break 

elseif lam>-le-6, 

disp( 'feasible set too small to proceed') 
break 

end 

YWl=aff in( [zeros (ma+nq2 ,ma) , Z] ,xiop,ma) ; 
xil=xiop; 



Syy= [1 ,ma] ; 

Rc= [zeros(ma,ma) , YY] ; 

Tb=eye( 1 , length (Ta)) ; 
lam=-l ; 

J2=[]; iteration=0; 



y. 

*/♦ defining/solving the controller problem-fit cond 2 

7 . 

disp( ' searching for new controller- fit cond 2') 
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[Ra,Sc2]=hinfres6( [A2 B22] ,CD,B12*B12 ’ ,gam,Z) ; 
lamin=max(eig(af f in(Ra,xi2) ) ) + 0.1; 

[xiop, lam2 , stat , err2] =c enters 3b ( Ra, Rb , Rc , Syy , xi2 , laroin , theta,prec , lel2) ; 
if err2~=0, 

err=3; return; 

elseif lam2>=0, 

disp( ’ centers could not find a new feasible controller (fc2)’) 
break 

end 

YW2=af f in( [zeros (ma+nq2 ,ma) , Z] , xiop ,ma) ; 
xi2=xiop ; 



7 . 

7, defining/solving the controller problem-fit cond 3 

7 . 

disp( * searching for new controller- fit cond 3*) 

[Ra,Sc2]=hinfres6([A3 B23] ,CD,B13*B13’ ,gam,Z) ; 
lamin=max(eig(af f in(Ra,xi3) ) ) + 0.1; 

[xiop, lam3 , stat , err2] = center s3b(Ra , Rb , Rc , Syy , xi3 , lamin , theta ,prec , lel2) ; 
if err2~=0 , 

err=3; return; 

elseif lam3>=0, 

disp( * centers could not find a new feasible controller (fc3)*) 
break 

end 

YW3=aff in( [zeros (ma+nq2 ,ma) ,Z] ,xiop,ma) ; 
xi3=xiop; 



7 . 

7. defining/solving the min airframe problem 

7 . 

disp( 'Optimizing plant for previous controlled ) 

[Tel , Sc l] =hinf res4(Aa, Bla,B2a , YW1 ,CD , gam) ; 

[Tc2 , Sc2] =hinf res4(Aa2 ,Bla2 ,B2a2 , YW2 , CD, gam) ; 

[Tc3 , Sc3] =hinf res4 (Aa3 , Bla3 , B2a3 , YW3 , CD , gam) ; 

7. use ’adiag’ to stack joint constraints 
Tc=adiag(Tcl ,Tc2) ; Tc=adiag(Tc ,Tc3) ; 

Sc= [Sc 1 ;Sc2;Sc3] ; 

J= J+1000*eps ; 

[zetaop , J , stat , err2] = c enters 3b (Ta,Tb ,Tc,Sc,zeta,J , theta ,prec , lel2) ; 
if err2~=0 
err=3 ; 



return ; 

end 

zeta=zetaop ; 

A=aff in(Aa,zeta) ; 
A2=af f in(Aa2 ,zeta) ; 
A3=affin(Aa3,zeta) ; 



Bl=af f in(Bla,zeta,nql) ; 
B12=af f in(Bla2 ,zeta,nql) ; 
B13=af f in(Bla3 , zeta , nql ) ; 



B2=aff in(B2a , zeta ,nq2) ; 
B22=af fin (B2a2 , zeta, nq2) 
B23=af f in ( B2a3 , zeta , nq2 ) 



J 1= [lam 1 , lam 2 , lam 3 , J] ; 
disp( J 1 ) 
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J2=[J2; lctinl , laiu2 , lam3 , J] ; 
if iteration>2, 

if ( J>0 . 999999* J2(iteration-l ,4) ) I iterat ion==50 , 
break 

end 

end 



end 

'/, Determine the controller 



Y1=YW1 (1 :ma, 


:); 


Wl=YWl(ma+l :raa+nq2 , 


); 


K 1=W1/Y1 ; 


Y2=YW2(1 :ma, 


:); 


W2=YW2(ma+l:ma+nq2, 


); 


K2=W2/Y2; 


Y3=YW3( 1 : ma , 


:); 


W3=YW3(ma+l :ma+nq2 , 


); 


K3=W3/Y3; 



loglog(-J2( : , 1) , J2( : ,2) , J2( : ,4), ’ + * ,-J2( : ,3) , J2( : ,4) > ’x ’) , 
grid ,title( ’Plant Cost vs. Controller Margin’) 
xlabel ( ’Controller Margin ’) ,ylabel( ’Plant Cost’) 

err=0 ; 
return; 

'/. end plant opt 5. m 



3. Joint Hoo Pole Placement Plant/Controller Optimization 

The function plantopt6 solves the plant/controller optimization problem 
where joint and pole placement performance constraints are imposed. The 

structure is identical to the optimization functions above, and the algorithm follows 
Section D.. The administrative functions hint res6 and hinfres4 above create the 
basis matrices for the constraint, while poleresl and poleres2 create the basis 

matrices for the pole placement constraint. The administrative function adiag is then 
used to create the joint bases. 

The significant difference between this code and the previous codes is that 
the Riccati solvers prior to the beginning of the iterative routines could only find 
a controller that satisfies the 7 i^, constraint, which was no guarantee of the exis- 
tence of a joint controller. The first pass through the algorithm therefore started 
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with a controller that was feasible, but which most likely failed to satisfy the 

pole placement constraint. The first pass therefore determined the feasibility of the 
problem. As mentioned in Chapter V, the failure of the algorithms to find a jointly 
feasible state-feedback controller did not by necessity mean that a feasible controller 
did not exist. 



plantopt6 

function 

[zeta,xi ,K,Z,Ra,Tc , J2 ,err]=. . . 

plant opt 6 (Aa , Bla ,B2a ,C ,D , zeta , weight , rad , alpha , theta , prec ) 

7. 

7* [K , val , err] =h2hinf sf ( Aa , Bla, B2a, C ,D , zet a, weight , gam, theta , prec) 

7. [K, val , err]=h2hinf sf (Aa, Bla, B2a,C ,D,zet a, weight ,gam) 

7. 

*/* Description: 

7. Given: 

7. xdot = A x + B1 w + B2 u, 

7, z = C x + Du, 

7. y = x , 

7. 

7# This function determines the minimum st at ef eedback plant satisfying 

7. | I T_zw | | _inf ty < 1, and closed-loop poles in the circular disc of radius r 

7. centered at (-(rad + alpha), 0), 

7. 

7. min J=weight * *zeta 
7. subject to the following 

7. 

7. R(Z) =AY+YA ’ +B2W +W >B2 '+B1B1 > + (CY +DW) * (CY +DW)< 0, 

7, 

7. and 

7. 

7. I A1Y+YA1 , +B2W(I+Al/r) , +(I + Al/r)W , B2 , + AlYAlVr B2*V I 

7. R(Z)= I I < 0, 

7. I V>B2' -Y/r I 

7. 

7. 

7. where A1=A + alpha*eye(A) 

7. 

7. Code alternatively finds controller, and minimizing plaint 
7. using the method of centers. 

7. 

7. Inputs: 

7. 

7. C , D are constant matrices from the state-space realization of the system. 

7. Aa, Bla and B2a are a-matrices which hold the affine elements 



7. zeta is the vector that defines the initial plant (A=af f in(AA ,zeta) ) 
7. weight is the row vector of weights in the objective function 
7. rad and alpha specify the circle 
7. theta parameter of the method of centers 

7. prec precision in the compute of the upper bound of the H2 norm. 

7 . 

7# Outputs: 

7. 

7. K the gain 

7* val the optimum value of the performance index computed by centers 
7* algorithm 

7. err error code, its value is err=l if the problem is infeasible, 

7. otherwise err=0. 



7. Called functions: 

7. basis, computes a basis for a set of block structured matrices 
7. hinfres, computes the a-matrix of a Riccati inequality restriction 
7* adiag, computes the a-matrix of diag( A(x) , B(x) ) 

7. atrace, computes the a-matrix of trace(R,X) 

7. aident, gives an a-matrix with the indept. term equals unity and 
7* the rest of matrices zeros. 

7* getvec, gives the realization of a matrix in a matrix basis. 

7* affin, computes an affin matrix function. 

7. 

7* Comments: 

7. 

7* The assumptions for this function are standard in the state-feedback 
7* Hinf case, (A,B2) stabilizable and D1 has full column rank. 

7. These assumptions are not checked, though they probably should be. 

7. If the inputs theta and prec are not provided, they are initialized 

7* to 0.1 and 0.001 respectively. If the circle parameters are not specified 

7. then they are set for a circle of radius 87.3, centered at -97.3 on the real 

7* axis . 

if nargin<=9, 

theta=0.1; prec=.001; 

if nargin<9, 

rad=87.3; alpha=0.5; 

end 



end 

[ma,na]=size(Aa) ; 
[mbl ,nbl] =size (Bla) ; 
[mb2 , nb2] =size(B2a) ; 
[me ,nc]=size(C) ; 



dimz=na/ma ; 
nql=nbl/dimz ; 
nq2=nb2/dimz ; 



7. Determine hinf feasibility/controller 
gam=l; 

A=af fin (Aa, zeta) ; Bl=aff in(Bla, zeta, nql ) ; B2=af fin (B2a, zeta, nq2) ; 

a=A-B2*((D , *D)\D > )*C; 

ham=[a, ( (B1*B1 , /gam~2)-B2*( (D* *D)\B2 9 ) ) ; -C ' * (eye(mc )-D* ( (D 1 *D)\D * ) ) *C , -a*]; 
[xl , x2 ,f ail] =ric_schr(ham) ; Xinf =x2/xl ; 

if (fail>0) I any (eig(Xinf )<0) , 
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return 



disp( * Initial System appears ini easible-1 ' ) ; 
else 

disp( * Initial Hint problem feasible*) 

end 

Kp=-(D**D)\(D**C+B2**Xinf); X controller 

7, Determine particular soln from controller 
al=A+B2*Kp; bl = [B1 , 10000*sqrt(eps)*eye(ma)] ; cl=C+D*Kp; 

[xl , x2 ,f ail] =ric_schr ( [al * ,cl * *cl ; -bl*bl * ,-al] ) ; 

Yp=x2/xl ; 

if (fail>0) I any(eig(Yp)<0) , 

disp( * Initial System appears inf easible-2 * ) ; return 

end 

Wp=Kp*Yp; 



X 

*/, Initializing the optimization 

X 

[Z, YY,dimz]=basis2(ma,nq2) ; 

Rb=eye (3*ma+mc , (dimz+1 ) *(3*ma+mc) ) ; 
CD= [C D] ; 

Ta= [0 , weight]; 

J=weight*zeta ; 
xi=getvec2( [Yp ; Wp] , Z) ; 



Syy= [1 ,ma] ; 

Rc= [zeros (ma,ma) , YY] 

Tb=eye(l , length (Ta)) 
lam=-l ; 

J2=[]; iteration=0 



while lamC-le-6, 



iteration=iteration+l 

X 

*/, defining/solving the controller problem 

X 

disp( 1 searching for new controller 1 ) 

[Ral , Sal] =hinf res6( [A B2] ,CD ,B1*B1 * ,gam,Z) ; 

[Ra2 , Sa2] =poleresl (A ,B2 , r ad , alpha , Z) ; 

'/, use adiag to form joint constraint 
Ra=adiag(Ral ,Ra2) ; Sac=[Sal ;Sa2;Syy] ; 

lamin=max(eig(af 1 in(Ra,xi) ) ) + 0.1; 

[xiop , lain , stat , err2] = centers 3d ( Ra , Rb , Rc , Sac , xi , lamin,theta,prec , lel2) 
if err2~=0, 

err=3; return; 

elseif lara>=0, 

disp( * centers could not find a new feasible controller*) 
break 

elseif lam>-le-6, 

disp( *1 easible set too small to proceed*) 
break 

end 

YW=aff in( [zeros(ma+nq2 ,ma) ,Z] ,xiop,ma) ; 

Y=YW( 1 :ma, : ) ; W=YW(ma+l :ma+nq2 , : ) ; 
xi=xiop; 

K=W/Y ; 
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•/. 

*/, defining/solving the min airframe problem 

% 

disp( ‘Optimizing plant for previous controller’) 

[Tel , Scl] 2 hinfres4(Aa,Bla,B2a,YW,CD,gam) ; 

[Tc2 , Sc2] =poleres2 ( Aa , B2a , rad , alpha, Y , W) ; 

Tc=adiag(Tcl , Tc2) ; Stac= [Scl ;Sc2] ; 

J=J+0. 1; 

[zetaop, J , stat , err2] =centers3d(Ta,Tb ,Tc , Stac , zeta, J , theta, prec , lel2) ; 
if err2"=0 
err=3 ; 
return; 

end 

zeta=zetaop ; 

A=af f in(Aa, zeta) ; Bl=af f in(Bla, zeta, nql ) ; B2=af fin (B2a, zeta, nq2) ; 

disp( ' [Lambda, J] 2 ') 
disp( [lam, J] ) 

disp('Closed Loop Poles 2 ') 

E=eig(A+B2*K) ; disp(E') 

if any (real(E)>=0) , 
err=4; 
return 

end 

J2=[J2; lam, J,zeta'] ; 
if iteration>2, 

if ( J==J2(iteration-l,2) ) I iteration==100 , 
break 

end 

end 



end 

disp( 'Final Closed Loop Poles 2 ') 

E=eig( A+B2*K) ; 
disp(E) 

loglog(-J2( : ,1) , J2( : , 2) , ' * ' ) ,grid , 

xlabel( 'Controller Margin' ) ,ylabel( 'Plant Cost') 

err=0 ; 
return; 

*/, end plantopt6.m 



poleresl 



function [F , Sf ] =poleres 1 ( A , B , rad , alpha , Z ) 
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•/. 

*/. [F, Sf ] =poleresl(A , B,rad , alpha, Z) 

’/. 

'/, Description: Pole Placement constraint. 

V. 

'/. This function determines the a-matrix of the convex restriction 

•/. 

*/. | A1Y+YA1 1 +BW(I+Al/r ) ' + (I + Al/r)W , B , + AlYAlVr B*V I 

V. R(Z) = I I < 0, 

7, I W 1 B 1 -Yr I 

•/. 

7 . 

7* Inputs: 

7. 

7 A , B , rad , alpha parameters of the restriction 
'/, Z basis for YW from basis2 

7. 

7. Outputs: 

7. 

7. F a-matrix of the restriction 
7. Sf block structure of F 
7. 

7* Comments: 

7. 

7# Note that in order to obtain the value of the restriction, we need a 

7. vector x= [xl xr] , then F(x)=F0+Fl*xl+ . . .Fr*xr , the block structure 

7. of F(x) is Sf. 

V, 

7 this basis is for pole placement 

[mz , nz] =size (Z) ; 

[ma,na] =size(A) ; 

[mb,nb] =size(B) ; 

dim=nz/ma; mm=2*ma; 

F=zeros(mm,mm*dim) ; 

Al=A+alpha*eye (ma) ; 
for i=l:dim, 

Y=Z ( 1 : ma, (i-l)*ma+l : (i-l)*ma+ma) ; 

V=Z(ma+l :ma+nb , (i-l)*ma+l : (i-1 ) *ma+ma) ; 

F2=B*W ; 

F1=A1*Y + ( Al/rad + eye (ma) ) *F2 > ; 

F( : , i*mm+l : (i+l)^mm) = [Fl+Fl (A1*Y*A1 1 /rad) , F2 ;F2 * , -Y*rad] ; 

end 

Sf = [1 , mm] ; 
return ; 

7 end poleresl 
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poleres2 



function [F,Sf] =poleres2(Aa,B2a,rad , alpha, Y , W) 

*/. 

7. [F , Sf ] =poler es2 ( Aa , B2a , rad , alpha , Y , W ) 

7. 

7, Description: 

7. 

7. This function determines the a-matrix of the convex restriction 

7. 

7. I (A+B*K+alpha*eye)*Y+Y*(A+B*K+alpha*eye) * (A+B*K+alpha*eye ) I 

7. R(Z)= -I I > 0, 

7. I ( A+B*K+alpha*eye) -inv(Y/r) I 

7. 

7. 

7. Inputs : 

7. rad, alpha, Y,W parameters of the restriction 
7. Aa, B2a bases for the plaint 

7. 

7. Outputs: 

7. F a-matrix of the restriction (returns R>0) 

7. Sf block structure of F 

7. 

7. Comments: 

7. 

7. Note that in order to obtain the value of the restriction, we need a 
7. vector x= [xl , . . . ,xr] , then F(x) =F0+Fl*xl+ . . .Fr*xr, the block structure 
7. of F(x) is Sf. 

7. 

7, this basis is for pole placement 



[raa.na] =size(Aa) ; 
[mb,nb] =size(B2a) ; 
dim=na/ma; 
F=zeros(mm,mm*dim) ; 
K=W/Y ; 



mm=2*ma ; 

nq2=nb/dim; 
Fz=zeros(ma,ma) ; 



Ai=Aa( : , 1 :ma) ; 

Bi=B2a( : , 1 :nq2) ; 

Fl=Ai+Bi*K+eye(ma) ; 

F( : , 1 : mm)=- [F1*Y+Y*F1 * ,F1 ;F1 ' ,-inv(Y/rad)] ; 



for i=2:dim, 

Ai=Aa( : , (i-1) *ma+l : i*ma) ; 

Bi=B2a( : , (i-l) *nq2+l : i*nq2) ; 

Fl=Ai+Bi*K ; 

F( : , ( i- 1 ) *mm+l : i*mm) =- [F1*Y+Y*F1 J .FljFl’ ,Fz] ; 

end 

Sf = [1 , mm] ; 
return; 

7. end poleres2 
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4. Plant/Controller Optimization with a Joint Static Maneu- 



verability Specification 

The design code plantopt2a is a minor modification to the baseline 
plant optimization code plantopt2. The static maneuverability specification must 
be posed as the basis (in () to an LMI external to the routine. This basis Da is then 
passed to plantopt2a as an input variable. During the plant optimization phase of 
the routine, Da is diagonally augmented to the basis for the 7Yoo specification using 
adiag. Because the typical termination conditions are different than the standard 
plant optimization problem, the termination criteria was modified slightly. The code 
that follows is otherwise identical to plantopt2, and required no additional subrou- 
tines. 



plantopt2a 

function [zeta,xi ,K ,Z , Rc ,Tc , J2 , err] = . . . 

plantopt2a( Aa , Bla , B2a , C ,D, Da, zeta, weight , thres , gam , theta , prec ) 

X 

X [zeta , xi ,K , Z , Rc ,Tc , J2, err] = . . . 

'/, plaint opt 2a ( Aa , Bla , B2a , C ,D , Da , zeta, weight , thres , gam , theta , prec ) 

X 

X Description: 

X Given: 

X xdot = A x + B1 w + B2 u, 

'/, z = C x + Du, 

x y = x , 
x 

'/, This function determines the minimum state-feedback plant satisfying 
'/. I I T_zv | | _inf ty < gamma and a static manuverability spec posed by Da. 

y. 

'/, min J=weight * *zeta 
'/, subject to 

y. 

y, R(xi , zeta) = AY+YA , +B2W +W , B2 , + B1B1*+(CY +DV)’(CY +DW ) < 0, 

X 

X and 
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y. 

*/* D(zeta) > 0 

•/. 

*/. Code alternatively finds central controller, and minimizing plant 
'/, using the method of centers. 

% 

*/, Inputs: 

•/. 

*/. C,D are constant matrices from the state-space realization of the system. 

'/. Aa, Bla and B2a are a-matrices which hold the affine elements 

*/, zeta is the vector that defines the initial plant (A=af f in(AA ,zeta) ) 

•/, weight is the row vector of weights in the objective function 
'/. thres is the threshold on the central controller margin 
'/, for determining when to quit the iterative procedure 

y, gam is a bound of the H-inf norm for the closed loop system. 

'/, theta parameter of the method of centers 

'/, prec is used by the method of centers to determine when to quit the newton 
'/, search for the analytic center. The default is 0.001, bur if the ricatti 

*/, soln indicates that the problem is feasible and yet the method of centers 

*/, cannot find a solution, then this parameter should be adjusted to something 

*/, smaller to allow the newton search to go deeper. 

'/, If the ricatti solvers indicate that the problem is feasible and yet the 

'/, method of centers cannot find a feasible controller, then this parameter 

'/. should be set smaller. 

y. 

'/, Outputs: 

y. 

'/, K the gain 

'/. val the optimum value of the performance index computed by centers 
'/, algorithm 

'/. err error code, its value is err=l if the problem is infeasible, 

*/, otherwise err=0 . 

X Called functions: 

% basis, computes a basis for a set of block structured matrices 
•/, hinfres, computes the a-matrix of a Riccati inequality restriction 
% adiag, computes the a-matrix of diag(A(x ) , B(x) ) 

'/• atrace, computes the a-matrix of trace(R,X) 

*1 aident , gives an a-matrix with the indept . term equals unity and 
% l the rest of matrices zeros. 

*/ getvec, gives the realization of a matrix in a matrix basis. 

*1 affin, computes an affin matrix function. 

•/. 

*/ Comments: 

•/. 

'/* The assumptions for this function are standard in the state-feedback 
*/ Hinf case, (A,Bl) stabilizable and D1 has full column rank. 

*/, These assumptions are not checked, though they probably should be. 

*/. If the inputs gam, prec and theta are not provided, they are initialized 
% to 1, 0.1 and 0.001 respectively. 
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if nargindl 

gam=l; theta=0.1; 

if nargin==7, 
thres=le-6 

end 

end 

[ma ,na] =size (Aa) ; 

[mbl ,nbl]=size(Bla) ; 

[mb2 ,nb2] =size(B2a) ; 

[me , nc] =size (C) ; 



prec= . 001 ; 



dimz=na/ma ; 
nql=nbl/dimz ; 
nq2=nb2/dimz ; 



*/, Determine hinf feasibility/central controller 

A=af f in(Aa,zeta) ; Bl=aff in(Bla , zeta , nql ) ; B2=af f in(B2a ,zeta , nq2) ; 

a=A-B2* ((D’*D)\D’)*C; 

ham= [a , ( (B1 *B1 1 /gam~2) -B2* ( (D ’ *D )\B2 ’ ) ) ; -C ’ * (eye(mc)-D* ( (D ’ *D )\D ’ ) ) *C , -a’] 
[xl , x2 ,f ail] =ric_schr (ham) ; Xinf =x2/xl ; 

if (fail>0) I any (eig(Xinf )<0) , 

disp( ’ Initial System appears inf easible-1 ’ ) ; return 
else 

disp( 'Initial Hinf problem feasible’) 

end 

Kp=- (D ’ *D)\(D ’ *C+B2 ’ *Xinf ) ; */, "central" controller 

'/. Determine particular soln from central controller 
al=A+B2*Kp; bl= [B1 , 10000*sqrt ( eps ) *eye (ma)] ; cl=C+D*Kp; 

[xl ,x2 ,f ail] =nc_schr ( [al ’ , cl ’ *cl ; -bl*bl ’ ,-al] ) ; Yp=x2/xl ; 

if (fail>0) | any (eig(Yp)<0) , 

disp( ’ Initial System appears inf easible-2 ’ ) ; return 

end 

Wp=Kp*Yp; 

V. 

*/, Initializing the optimization 

% 

[Z , YY ,dimz] =basis2(ma ,nq2) ; 

Rb=eye(ma+mc , (dimz+ 1 ) * (ma+mc ) ) ; 

CD= [C D] ; 

Ta= [0 , weight] ; 

J=weight*zeta ; 
xi=getvec2( [Yp;Vp] ,Z) ; 



Syy=[l ,ma] ; 

Rc= [zeros (ma.ma) , YY] ; 

Tb=eye( 1 , length(Ta) ) ; 
lam=- 1 ; 

J2=[]; iteration=0; 



while lam<-le-12, 



iteration=iterat ion+1 

V. 

V, defining/solving the central controller problem 

# /. 

disp( ’ searching for new central controller’) 
[Ra,Sc2]=hinfres6( [A B2] ,CD,B1*B1 ’ ,gam,Z) ; 
lamin=max(eig(af f in(Ra.xi) ) ) + 0.1; 
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[xiop, lam , stat , err 2] =centers3(Ra, Rb , Rc ,Syy , xi , lamin , theta ,prec , lel2) ; 
if err2~=0, 

err=3; return; 

elseif lam>=0, 

disp( * centers could not find a new feasible controller*) 
break 

elseif lam>-thres, 

disp( *f easible set too small to proceed*) 
break 

end 

YW=affin( [zeros(ma+nq2 ,ma) ,Z] ,xiop,ma) ; 

Y= YW ( 1 : ma , : ) ; V= YW (ma+ 1 : ma+nq2 , : ) ; 

xi=xiop; 

K=W/Y ; 



Y. 

*/« defining/solving the min airframe problem 

V. 

disp( *Optimizing plant for previous controller*) 

[Tel ,Scl]=hinfres4(Aa,Bla,B2a, YW,CD ,gam) ; 

Tc = adiag(Tcl ,Da) ; 

Sc = [Scl ; 1 1] ; 

J= J+ . 1 ; 

[zetaop , J , stat , err2] = centers 3 (Ta, Tb ,Tc ,Sc , zeta, J , theta, prec , lel2) ; 
if err2~=0 
err=3 ; 
return ; 

end 

zeta=zetaop; 

A=af fin (Aa , zeta) ; Bl=af f in(Bla,zeta,nql ) ; B2=af fin (B2a, zeta, nq2) ; 

disp( [lam, J] ) 

J2=[J2; lam, J, zeta*]; 
disp(*Closed Loop Poles=*) 

E=eig(A+B2*K) ; disp(E’) 

if any (real(E)>=0) , 
err=4; 
return 

end 

if iteration>2, 

if (J>0 . 999999* J2 ( it erat ion- 1 , 2) ) I iterat ion==100 , 
break 

end 

end 



end 

7. Determine the controller 



Y=YW( 1 :ma, : ) ; 
W=YW(ma+l :ma+nq2 , : ) ; 
K=W/Y ; 
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loglog(-J2( : , 1) , J2( : ,2) , 1 * 1 ) ,grid, title( ’Plant Cost vs. Controller Margin’) 
xlabel (’ Central Controller Margin ’), ylabel( ’ Plant Cost’) 

err=0; 

return; 

% end plantopt2a.m 



5. Plant/Cont roller Optimization with Dynamic Maneuverability 

Constraints 

As discussed in Chapter V, dynamic maneuverability requirements can ei- 
ther be imposed using a closed-loop Hoc constraint or second formulation based upon 
determinantal relationships. For the first method, the original code plantopt2 

is suitable without modification. The following code, plantopt9 use the Lyapunov 
formulation. The subroutines actresl and actres2 perform the formation of the 
bases matrices of the LMI associated with this constraint. 

In practice, plantopt2 was used for Example problem 5, and the following 
code routinely resulted in the method of centers departing the feasible set. This 
suggests a feature in the geometry of the constraint which centers3 could not handle. 
Given more reliable interior point codes, and the fact that both formulations were 
conservative, it would be interesting to see which of the two formulations for the 
dynamic maneuverability requirements resulted in a lower final plant cost. 

plantopt9 

function [zeta,xi ,K,Z,Ra,Tc, J2,err]=. . . 

plant opt9(Aa,B la, B2a,B3a,C , D ,zet a, weight , umax, thres , theta,prec) 

X 

*/, [zeta,xi,K,Z,Ra,Tc, J2,err]=. . . 

'/♦ plantopt9(Aa,Bla,B2a,B3a, C ,D ,z eta, weight ,umax , theta,prec) 

*/• [zeta,xi ,K ,Z ,Ra,Tc , J2 , err] =plantopt9(Aa,Bla,B2a, B3a,C ,D ,zeta, weight ,umax) 

X 

*/♦ Description: 



*/, Given: 

*/, xdot = Ax+Blw+B2u, 

*/, z = C x + Du, 

% y = x, 

X 

7, This function determines the minimum state-feedback plant satisfying 
7. I lT_zw I Linfty < 1, said open-loop actuator limitation, 

7. 

*/, min J=weight '*zeta 

*/* subject to the following 

y. 

y. R(Z) = AY+YA 1 +B2W +V'B2' + B1B1 » +(CY+DW)(CY +DW) * < 0 

y. 

*/, and 

y. 

•/, F(Z)=AY+B2W+B3W(i , : )/u_max(i) + (AY+B2W+B3W( i , : )/u_max(i)) 1 < 0 

•/. 

*/, Code alternatively finds central controller, and minimizing plant 
*/, using the method of centers. 

y. 

*/, Inputs: 

*/. 

*/, C,D are constant matrices from the state-space realization of the system. 

*/♦ Aa, Bla, B3a said B2a sore a-raatrices which hold the affine elements 

*/, Bla corresponds to the exogenous disturbance inputs 

*/, B3a corresponds to the exogenous commsoid inputs 

*/, zeta is the vector that defines the initial plsoit ( A=af f in(AA , zeta) ) 

*/* weight is the row vector of weights in the objective function 

*/, thres determines the central controller margin threshold at which 

7, the set of feasible control is considered too small to proceed 

V, Should usually be set to le-6 to le-10. Default = le-9 

*/, prec establishes how deep the newton search will proceed looking for 

*/, the analytic center. Default = le-6 

•/. 

*/, Outputs: 

*/, z2 output vector zeta of minimized plant parameters 
*/, xi vector of optimal controller parameters 
% 



*/, Called functions: 

*/, basis, computes a basis for a set of block structured matrices 
*/, hinfres, computes the a-matrix of a Riccati inequality restriction 
'/, adiag, computes the a-matrix of diag(A(x) , B(x) ) 

*/, atrace, computes the a-matrix of trace(R,X) 

*/, aident, gives an a-matrix with the indept . term equals unity said 
*/, the rest of matrices zeros. 

*/* getvec, gives the realization of a matrix in a matrix basis. 

*/. affin, computes an affin matrix function. 

V. 

*/, Comments : 

y. 



V The assumptions for this function are standard in the state-feedback 
*/. Hinf case, (A,B2) stabilizable and D1 has full column rank. 

*/, These assumptions are not checked, though they probably should be. 

*/, If the inputs theta and prec are not provided, they are initialized 
*1 to 0.1 and 0.001 respectively, 
if nargin==9, 

thres=le-9; theta=0.1; prec=le-6; 

else nargin<9, 

error (’ Insuff icent number of input arguments’) 

end 

[ma,na] =size(Aa) ; dimz=na/ma; 

[mbl ,nbl] =size (Bla) ; nql=nbl/dimz ; 

Cmb2,nb2]=size(B2a) ; nq2=nb2/dimz ; 

[me ,nc] =size(C) ; 

V, Determine hinf feasibility/central controller 
gam=l ; 

A=af f in(Aa,zeta) ; Bl=af f in(Bla,zeta,nql) ; B2=af f in(B2a , zeta , nq2) ; 

B3=af f in(B3a,zeta, 1) ; 

a=A-B2*((D’*D)\D’)*C; 

ham= [a , ( (B1*B1 ’/ganT2)-B2*( (D ’ *D)\B2 ' ) ) ; -C ’ * (eye (me ) -D* ( (D 1 *D ) \D ’ ) ) *C , -a'] 
[xl ,x2 ,f ail] =ric_schr (ham) ; Xinf =x2/xl ; 

if (fail>0) I any ( eig(Xinf ) <0) , 

disp( 1 Initial System appears inf easible-1 ’ ) ; return 
else 

disp( ’ Initial Hinf problem feasible’) 

end 

Kp=-(D’*D)\(D’*C+B2’*Xinf ) ; '/, central controller 

V, Determine particular soln from central controller 
al=A+B2*Kp; bl= [B 1 , 10000*sqrt (eps ) *eye(ma)] ; cl=C+D*Kp; 

[xl , x2 ,f ail] =ric_schr ( [al ’ ,cl ’ *cl ; -bl*bl * ,-al] ) ; 

Yp=x2/xl; 

if (fail>0) I any (eig(Yp)<0) , 

disp( ’ Initial System appears inf easible-2 ’ ) ; return 

end 

Vp=Kp*Yp; 



Vi 

V* Initializing the optimization 

Vi 

[Z , YY ,dimz] =basis2(raa ,nq2) ; 
Rb=eye(3*ma+mc , (dimz+1 ) * (3*ma+mc) ) ; 
CD= [C D] ; 

Ta=[0, weight]; 

J=weight*zeta ; 
xi=getvec2( [Yp; Wp] ,Z) ; 



Syy=[l ,ma] ; 

Rc= [zeros (ma,ma) ,YY] 

Tb=eye( 1 , length (Ta ) ) 
lam=- 1 ; 

J2=[]; iteration=0 



while lam<-le-12. 



iteration=iteration+l 
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y. 

*/, del ining/solving the central controller problem 

V. 

disp( 1 searching lor new central controller*) 

[Ral , Sal] =hinlres6( [A B2] , CD, B1*B1 * ,gam, Z) ; 

[Ra2 ,Sa2] =actresl (A, B3 ,B2 ,umax , Z) ; 

Ra=adiag(Ral ,Ra2) ; Sac=[Sal ;Sa2;Syy] ; 

lamin=max(eig(allin(Ra,xi))) + 0.1; 

[xiop, lam , stat , err 2] =centers3d(Ra, Rb , Rc , Sac ,xi, lamin , theta, prec , lel2) ; 
il err2~=0, 

err=3; return; 

elseil lam>=0, 

disp( * centers could not lind a new leasible controller*) 
break 

elseil lam>-thres, 

disp( * leasible set too small to proceed*) 
break 

end 

YW=allin( [zeros (ma+nq2 ,ma) ,Z] ,xiop,ma) ; 

Y=YW( 1 :ma, :); V=YV(ma+l :ma+nq2, :); 
xi=xiop; 

K=W/Y ; 



y. 

'/. delining/solving the min airlrame problem 

y. 

disp( * Optimizing plant lor previous controller’) 

[Tel ,Scl]=hinlres4(Aa,Bla,B2a, YW,CD,gam) ; 
[Tc2,Sc2]=actres2(Aa,B3a,B2a,umax,W ,Y) ; 

Tc=adiag(Tcl ,Tc2) ; Stac= [Scl ; Sc2] ; 

J= J+10 ; 

[zetaop, J , stat , err 2] =centers3d(Ta , Tb , Tc , Stac , zeta , J , theta, prec , lel2) ; 
il err2"=0 
err=3 ; 
return ; 

end 

zeta=zetaop; 

A=all in( Aa, zeta) ; Bl=all in(Bla,zeta,nql) ; B2=all in(B2a,zeta,nq2) ; 

B3=af 1 in(B3a ,zeta , 1) ; 
disp( ’ [Lambda, J]=*) 
disp( [lam, J] ) 

disp( ’Closed Loop Poles=*) 

E=eig(A+B2*K) ; disp(E’) 

il any (real(E)>=0) , 
err=4 ; 
return 

end 

J2=[J2; lam, J,zeta*]; 
il iteration>2, 

il ( J==J2(iteration-l , 2) ) I iteration==100 , 
break 



end 



end 



end 

dispC’Final Closed Loop Poles^) 

E=eig( A+B2*K) ; 
disp(E) 

loglog(-J2(: ,1),J2(: ,2), '*’),grid, 

xlabel( 'Central Controller Margin ' ), ylabel (* Plant Cost') 

err=0 ; 
return ; 

7 end plantopt6 . in 



actresl 

function [F , Sf]=actresl (A , B3,B2,umax , Z) 

7 

7 [F , Sf ] =actres 1 (A , B1 , B2 ,umax , Z) 

7 

7 Description: Open-Loop constraint. 

7. 

7 . This function determines the a-matrix of the affine restriction 

7 . 

7 F(Z)=AY+B2W+B3W(i, : )/u_max ( i) + ( AY+B2V+B3V( i , : )/u_max ( i) ) ' < 0 

7 

7 Inputs : 

7 

7 A , B1 , B2 ,umax parameters of the restriction 
7 Z basis for YW from basis2 
7 

7 Outputs : 

7 

7 F a-matrix of the restriction 
7 Sf block structure of F 

7 

7 Comments : 

7 

7 Note that in order to obtain the value of the restriction, we need a 
7 vector x= [x 1 , . . . , xr] , then F(x)=FO+Fl*xl+ . . .Fr*xr , the block structure 
7 of F(x ) is Sf. 

7 . 

7 this basis is for open loop actuator limitations 

7 

nu=length(umax ) ; 

[mz ,nz] =size(Z) ; 
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[ma,na] =size(A) ; 

Cmb3,nb3]=size(B3) ; 

Cmb2,nb2]=size(B2) ; 
dim=nz/ma; 

F= [] ; Sf = [] ; 
for k=l :nu , 

FO=zeros(ma,ma*( 1+dim) ) ; 
for i=l:dim, 

Y=Z( 1 :ma, (i-l)*ma+l : (i-1 ) *ma+ma) ; 
W=Z(ma+l :ma+nb2, (i-l)*ma+l : (i-l)*ma+ma) ; 
Fl=A*Y+B2*W+B3/umax(k)*W(k, : ) ; 

F0( : , i*ma+l : (i+l)*ma)=Fl+Fl J ; 

end 

F=adiag(F,FO) ; 

Sf = [Sf ; 1 ,ma] ; 

end 

return ; 

'/, end actresl 



actres2 



function [F,Sf]=actres2(Aa,B3a,B2a,umax ,W,Y) 

[F,Sf ] =actres2(Aa, B3a,B2a,umax , W , Y) 

*/. 

'/» Description: Open-Loop constraint. 

7 . 

7, This function determines the a-matrix of the affine restriction 

7 . 

7 . F(Z)=-(AY+B2W+B3W(i , : )/u_max(i) + ( AY + B2V+B3V( i , : )/u_raax ( i) ) > ) > 0 
*/» 

7 . Inputs: 

7 . 

7 . umax,Y,W parameters of the restriction 
7 . Aa,Bla,B2a bases for the plant parameters 
7 . 

7 . Outputs: 

7 . 

7 . F a-matrix of the restriction 
7 , Sf block structure of F 
7 . 

7 . Comments: 

7 . 

7 . Note that in order to obtain the value of the restriction, we need a 
7 , vector x= [xl , . . . , xr] , then F(x)=FO+Fl*xl+ . . .Fr*xr , the block structure 
7 . of F(x) is Sf. 

7 . 
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'/. this basis is lor open loop actuator limitations 

7 , 



nu=length(umax ) ; 

[ma,na] =size(Aa) ; 

[mb3 ,nb3] =size(B3a) ; 

[mw ,nw] =size(W) ; 
dim=na/ma; 

il nb3>dim, error('B3 matrix needs to have one column'), end 
F= [] ; Sl = [] ; 
lor k=l :nu, 

FO=zeros (ma ,ma*dim) ; 
lor i=l:dim, 

Ai=Aa( : , (i-1 ) *ma+l : i*ma) ; 

B3i=B3a( : ,i) ; 

B2i=B2a( : , (i-1 )*mw+l : i*mw) ; 
Fl=Ai*Y+B2i*W+B3i/umax(k)*W(k , : ) ; 

F0( : , (i-1 ) *ma+l : i*ma)=-(Fl+Fl ' ) ; 

end 

F=adiag(F , FO) ; 

Sf=[Sl ;l,ma] ; 

end 

return ; 

*/. end actres2 



6. Plant/Controller Optimization with Robustness Constraints 

As discussed in Chapter V, the 7Yoo constraint can be used to pose ei- 
ther disturbance rejection or robustness constraints on a plant optimization problem. 
The formulation of robustness constraints is slightly different than the imposition 
of turbulence rejection specifications due to the structure of the problem. A sepa- 
rate plant optimization function (plant opt 10) was consequently required, as well as 
an additional subroutine (hinfres9) which could form the basis for the robustness 
constraint. 

plantoptlO 

lunction [zeta,xi,K,Z,Ra,Tc,J2 ,err]=. . . 

plantopt 10 (Aa , Bla , B2a, C ,D ,B3 , C3a , D3a , z eta , weight , thres , theta, prec) 
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% 

7. [zeta,xi ,K ,Z ,Ra,Tc , J2,err]=. . . 

7. plantoptlO(Aa,Bla,B2a,C ,D,B3 ,C3a,D3a, zeta, weight , thres ,theta,prec) 

7. 

V. 

7. Description: 

'/. Given: 

7. xdot = A(zeta) x + Bl(zeta) w + B2(zeta) u + B3 w3, 

*/. z = C x + Du, 

7. z3 = C3(zeta)x + D3(zeta) u 

7. y = x, 

7. 

7, This function determines the minimum statef eedback plant satisfying 
7. I lT_zw| |_infty < 1, and I |T_z3v3| Linfty < 1: 

7. 

7. min J=weight * *zeta 

7. subject to the following 

7. 

7. R(Z)= AY+YA 1 + B2W +W >B2 *+BlBl * + (CY +DW) , (CY +DW) < 0, 

7. 

7. and 

7. 

7. R(Z)= AY+YA , +B2W +W J B2 • +B3B3 ' + (C3Y +D3W)’(C3Y +D3W) < 0, 

7. 

7. Code alternatively finds central controller, and minimizing plant 
7. using the method of centers. 

7. This function was specifically intended to solve the hinf/hinf 
7. problem where T_z3w3 is the uncertainty transfer function 
7. (and the plant parameters show up in (C3,D3)). 

7. 

7. Inputs: 

7. 

7, C,D,B3 are constant matrices from the state-space realization of the system. 

7. Aa, Bla, B2a,C3a, and D3a are a-matrices which hold the affine elements 
7. zeta is the vector that defines the initial plant (A=af f in( AA ,zeta) ) 

7, weight is the row vector of weights in the objective function 
7. thres determines the controller margin below which the routine quits 
7. theta parameter of the method of centers 

7. prec precision in the compute of the upper bound of the H2 norm. 

7. 

7. Outputs; 

7. 

7. K the gain 

7. err error code, its value is err=l if the problem is infeasible, 

7. otherwise err=0. 

7. Called functions: 

7. basis, computes a basis for a set of block structured matrices 
7. hinfres, computes the a-matrix of a Riccati inequality restriction 
7. adiag, computes the a-matrix of diag(A(x) ,B(x) ) 

7. atrace, computes the a-matrix of trace(R,X) 
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'/. aident , gives an a-matrix with the indept . term equals unity and 
'/♦ the rest of matrices zeros. 

'/. getvec, gives the realization of a matrix in a matrix basis. 

'/. affin, computes an affin matrix function. 

y. 

'/* Comments : 

y. 

'/♦ The assumptions for this function are standard in the state-feedback 
'/, Hinf case, (A,B2) stabilizable and D1 has full column rank. 

'/♦ These assumptions are not checked, though they probably should be. 



[ma ,na] =size(Aa) ; 

[mbl ,nbl]=size(Bla); 
[mb2 ,nb2] =size(B2a) ; 
[me ,nc] =size(C) ; 

[me 3 ,nc3] =size(C3a) ; 

A=af f in( Aa , zeta) ; 

C3=af f in(C3a,zeta,ma) ; 



dimz=na/ma; 
nql=nbl/dimz ; 
nq2=nb2/dimz ; 



Bl=af f in (Bla , zeta ,nql ) ; 
D3=aff in(D3a,zeta,nq2) ; 



=af f in(B2a ,zeta , nq2) ; 



'/♦ Determine hinf feasibility/central controller 
gam=l; 

a=A-B2*((D , *D)\D , )*C; 

ham= [a, ( (B1*B1 * /gam~2)-B2*( (D 1 *D)\B2* ) ) ; -C 1 * (eye(mc) -D* ( (D » *D)\D ’ ) ) *C , -a 
[xl , x2,f ail] =ric_schr(ham) ; Xinf=x2/xl ; 

if (fail>0) | any (eig(Xinf )<0) , 

disp( 'Initial System appears inf easible- 1 ’ ) ; return 
else 

disp( ' Initial Hinf problem feasible 1 ) 

end 

Kp=-(D* *D)\(D ’ *C+B2 ’ *Xinf ) ; */, central controller 

*/, Determine particular soln from central controller 
al=A+B2*Kp; bl= [B 1 , 10000*sqrt(eps)*eye(ma)] ; cl=C+D*Kp; 

[xl ,x2,f ail] =ric_schr( [al 1 ^l'+cli-bl^bl' ,-al]); 

Yp=x2/xl ; 

if (fail>0) I any (eig(Yp)<=0) , 

disp( 1 Initial System appears inf easible-2 ’ ) ; return 

end 

Wp=Kp*Yp ; 

•/. 

'/, Initializing the optimization 

•/. 

[Z, YY,dimz] =basis2(ma,nq2) ; Syy= [l ,ma] ; 

Rb=eye(2*ma+mc+rac3 , (dimz+1 )* (2*ma+mc+mc3) ) ; 

Rc= [zeros (ma ,ma) , YY] ; 

CD= [C D] ; 

Ta=[0, weight]; Tb=eye( 1 , length(Ta) ) ; 

J=weight*zeta; lam=-l; 



xi=getvec2( [Yp;Wp] ,Z) ; 



J2= [] ; 



iterat ion=0 ; 



while lam<-le-12, 

iteration=iteration+l 

7 , 

'/. defining/solving the controller problem 

y. 

disp( 'searching for new controller') 

[Ral , Sal] =hinf res6( [A B2] , CD , B1*B1 ' ,gam, Z) ; 

[Ra2 ,Sa2] =hinf res6( [A B2] , [C3 D3] ,B3*B3' ,gam,Z) ; 

Sac= [Sal ; Sa2 ; Syy] ; 

Ra=adiag(Ral ,Ra2) ; 
lamin=max(eig(af f in(Ra, xi) ) ) ; 
if lamin>=0 , 

lamin=lamin*l . 1 ; 
else , 

lamin=lamin+0. 1 ; 

end 

[xiop, lam, stat ,err2]=centers3d(Ra f Rb,Rc,Sac,xi , lamin ,theta,prec, le24) ; 
if err2~=0 , 

err=3; return; 

elseif lam>=0, 

disp( ' centers could not find a new feasible controller') 
break 

elseif lam>-thres, 

disp( 'feasible set too small to proceed') 
break 

end 

YW=af f in( [zeros (ma+nq2 ,raa) ,Z] , xiop,ma) ; 

Y=YW(l:raa, :); W=YW(ma+l :ma+nq2 , : ) ; 
xi=xiop ; 

K=W/Y ; 



% 

*/. def ining/solving the rain airframe problem 

% 

disp( 'Optimizing plant for previous controller') 

[Tel , Scl]=hinfres4(Aa,Bla,B2a, YW,CD,gam) ; 

[Tc2 , Sc2] =hinf res9(Aa,B2a , B3 ,C3a ,D3a, YW) 

Tc=adiag(Tcl ,Tc2) ; Stac= [Scl ; Sc2] ; 

J= J+l ; 

[zetaop , J , stat , err 2] = cent ers3d(Ta,Tb,Tc, Stac ,zeta, J , theta, prec , le24) ; 
if err2"=0 
err=3 ; 
return ; 

end 

zeta=zetaop ; 

A=af f in(Aa,zeta) ; Bl=af f in(Bla ,zeta ,nql ) ; B2=aff in(B2a,zeta ,nq2) ; 

C3=af f in(C3a,zeta,ma) ; D3=aff in(D3a,zeta,nq2) ; 
disp( ' [Lambda, J]=') 
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disp( [lam, j] ) 

disp(’Closed Loop Poles^’) 

E=eig(A+B2*K) ; disp(E 1 ) 

if any (real(E)>=0) , 
err=4 ; 
return 

end 

J2=[J2; lam, J,zeta’]; 
if iterat ion>2 , 

if (J==J2( iteration-1 , 2) ) I iterat ion==100 , 
break 

end 

end 



end 

disp(' Final Closed Loop Poles^) 

E=eig(A+B2*K) ; 
disp(E) 

if isempty(J2), return, end 
loglog(- J2( : ,1) ,J2(: ,2), '♦O.grid, 

xlabel( * Central Controller Margin ' ), ylabel (’ Plant Cost') 

err=0 ; 
return ; 

7. end plantoptlO.m 



hinfres9 

function [R, Sf ] =hinf res9(Aa, B2a ,B3 , C3a ,D3a, YW) 

7 . 

7, [R,Sf]=hinf res4(Aa,Bla ,B2a, YW,CD,gam) 

7. 

7. Description: 

7. 

7. This function determines the a-matrix of the convex restriction 

7. 

7. 





1 AY+B2W+YA ’ +W ’B2 ’ +B3B3 ’ 


(C3Y+D3V) ’ 


1 


R(zeta) = 


1 

1 (C3Y+D3W) 


- eye 


1 < 0 
1 



7. 

7# This subroutine was written for use with plantoptlO 

7. Note that zeta_i > 0 is not enforced since that is done by hinfres4 

7. 

7. Inputs: 

7. 



241 



7. Aa,B2a, C3a,D3a are a-matnces of the plant 

7. YW,B3 constant parameters of the restriction (YW is the packed form [Y;W]) 
7. 

7, Outputs: 

7. 

7. R a-matrix of the restriction (-R>0 is actually returned) 

7. Sf block structure of R 

7. 

7. Comments: 

7. 

7. Note that in order to obtain the value of the restriction, we need a 
7. vector x= [xl , . . . , xr] , then R(x)=R0+Rl*xl+ . . .Rr*xr, the block structure 
7. of R(x) is Sf. 

7. 

[ma,na] =size(Aa) ; dim=na/ma; 

Cmb2,nb2]=size(B2a) ; nq2=nb2/dim; 

[mc3 ,nb3] =size(C3a) ; 
il=ma+mc3 ; 

R=zeros(il ,dim*(il) ) ; 

Fl= [Aa( : , 1 :ma) ,B2a( : ,l:nq2)]*YW; 

F2= [C3a( : ,l:ma),D3a(: ,l:nq2)] 

R(l:il,l:il)=-[F1+Fl * +B3^B3* , F2’;F2 ,-eye(nql)]; 

F3=zeros(mc3) ; 
for i=l:dim-l, 

Fl = [Aa( : , i^ma+1 : i^ma+ma) ,B2a( : , i*nq2+l : i^nq2+nq2)] ♦YW; 

F2= [C3a( : , i^ma+1 : i*ma+ma) ,D3a( : , i*nq2+l : i*nq2+nq2)] ♦YW ; 

R(dim: il , (i^il+dim) : (i*il + il))=- [Fl+Fl 1 ,F2 1 ;F2 ,F3] ; 

end 

Sf = [l , il] ; 
return ; 

7. end hinfres9 



7. Joint 7^2 / Pole-Placement Plant/Controller Optimization 

A design code was also produced to solve the plant /controller optimization 
problem subject to a joint 7 i 2 /pole-placement performance constraint (plantopt8b). 
The 7i 2 performance measure was not considered to be as useful as the 7 problem, 
and it was not used for any of the example problems. This code is consequently 
included for archival purposes only. The subroutines h2resl and h2res2 prepared 
the basis matrices for the 7i 2 constraint. Interested readers should consult [Ref. 29] 
for a discussion of the generalized 7i 2 cost. The derivation of the expressions used in 



these subroutines is straightforward from the expressions in this reference. 



plantoptSb 



function 

[zeta , xi ,K , Z , Ra , Rc , J2 , err] = . . . 

plai\topt8(Aa,Bla,B2a,C , D , zeta , weight , gam, theta, prec) 

% 

7# [zet a ,xi,K,Z,Ra,Tc,J2, err] =plantopt8 ( Aa ,Bla ,B2a, C , D1 ,D2 , zeta, weight , gam , theta , prec ) 
7. [zeta,xi,K,Z,Ra,Tc, J2,err]=plantopt8(Aa,Bla,B2a,C,Dl ,D2 , zeta, weight ) 

7. 

7* Description: 

7. Given: 

7* xdot = A x + B1 w + B2 u, 

7* z = Cx+ + D u, 

7. y = x, 

7. 



This function determines the minimum plant and associated state-feedback 
controller satisfying I I T_zw | | _2 (gen ’ 1 ) < 1, and closed-loop poles in the 
circular disc of radius r, centered at (-(rad + alpha), 0). The 

min J=weight ’ *zeta 
subject to the following 



R1(Z)= 



and 



R2(Z)= 



AY+YA , +B2W +W ' B2 ’ B1 

B 1 * -eye 

0 0 

0 0 



0 

0 



where A1=A + alpha*eye(A) 

Code alternatively finds controller, and minimizing plant 
using the method of centers. 



0 

0 



I < 0, 



CYC'+DWC'+CW’D’-eye DW I 

W , D > Y I 



I AlY+YAl , +B2W(I+Al/r)’ + (I+Al/r)V , B2 , + AlYAlVr B2*W 

I 

I V'B2’ -Y*r 



< 0 , 



7. Inputs: 

7. 

7* C,D1,D2 are constant matrices from the state-space realization of the system. 
7* Aa, Bla and B2a are a-matrices which hold the affine elements 
7. zeta is the vector that defines the initial plant (A=af f in (AA ,zeta) ) 

7. weight is the row vector of weights in the objective function 
7. gam is a bound of the H-inf norm for the closed loop system. 

7. theta parameter of the method of centers 
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7. prec precision in the compute of the upper bound of the H2 norm. 

7. 

7. Outputs: 

7. 

7. K the gain 

7. val the optimum value of the performance index computed by centers 
7* algorithm 

7. err error code, its value is err=l if the problem is infeasible, 

7. otherwise err=0. 



7* Called functions: 

7* basis2, computes a basis for Y and W 

7. h2res , computes the a-matrix of the H-2 restriction 

7* poleres , computes the a-matrix of the pole placement restriciton 

7* adiag, computes the a-matrix of diag( A(x) , B(x) ) 

7. atrace, computes the a-matrix of trace (R,X) 

7* aident, gives an a-matrix with the indept. term equals unity and 
7* the rest of matrices zeros. 

7# getvec2, gives the realization of a matrix in a matrix basis. 

7. affin, computes an affin matrix function. 

7. 

7# Comments: 

•/• 

7. The assumptions for this function are standard in the state-feedback 

7. Hinf case, (C1,A,B2) detectable and stabilizable and D2 has full column rank. 

7. These assumptions are not checked, though they probably should be. 



7. If the inputs gam, theta and prec 
7. to 1,0.1 and 0.001 respectively, 
if nargin==8, 

gam=l; theta=0.1; 

end 

[ma,na] =size(Aa) ; 

[mbl ,nbl] =size(Bla) ; 

[mb2,nb2] =size(B2a) ; 

[me ,nc] =size(C) ; 

7. Inital Plant 

A=af f in(Aa,zeta) ; Bl=affin 



are not provided, they are initialized 

prec= . 001 ; 

dimz=na/ma; 

nql=nbl/dimz; 

nq2=nb2/dimz; 



a,zeta,nql ) ; B2=af f in(B2a , zeta,nq2) ; 



7. Find a good starting point (in the circle, Yp>0, and (A+BK)Y+Y(A+BK) '+B1B1 * <0) 
Poles= [-5 : -1 : -4-ma] ; 

Kp=place( A , B2 , Poles) ; % L warning: place returns A-BK stable 

Yp=lyap( ( A-B2*Kp) ,B1*B1 1 ) ; 

Yp=(Yp+Yp ' )/2; 7* this corrects for inaccuracies in lyap 

Wp=-Kp*Yp ; 

[Z, YY,dimz]=basis2(ma,nq2) ; 
xi=getvec2( [Yp;Wp] ,Z) ; 



7* Admin 
CD= [C D]; 



Ta=[0, weight] ; 
J=weight*zeta; 

J2=[]; iteration=0; 



Tb=eye( 1 , length(Ta) ) ; 
lam=- 1 ; 



7 . Set the circle criterion 
rad=87 . 3 ; 



alpha=l ; 



while lam<-le-6, 



iter at ion=iterat ion+1 

7 . 

7, defining/solving the controller problem 

7 . 



disp( ’ Searching for new controller’) 

[R1 ,S1 , R2 ,S2] =h2resl (3 , [A B2] ,C,D,B1*B1 \Z) ; 

[R3 ,S3] =poleresl (A ,B2,rad, alpha, Z) ; 7 . poleres implicitly enforces Y>0 

if iteration== 1 , 

7 . Mathematically the initial xi found above should satisfy all but R2 
7 . Numerically it doesn’t work that well so we first need to find a feasible xi 
Ra=adiag(Rl ,R2) ; Ra=adiag(Ra , R3 ) ; 

Rb=eye(size(Ra) ) ; 

Rc= [zeros (ma ,ma) , YY] ; 

Sac= [SI ; S2 ; S3 ; 1 ,ma] ; 



7 . Note that the controller margin jumps since the objective function changes 
Rb=eye(ma , (dimz+1 ) *ma) ; 

Rc=adiag(-R2 ,-R3) ; 

Sac= [SI ; S2 ; S3] ; 

end 

lamin=max( eig(af f in(Ra ,xi) ) ) + 0.1; 

[xiop , lam , stat , err2] =c enters 3d ( Ra , Rb , Rc , Sac , xi , lamin , theta ,prec , le 12) ; 
if err2~=0, 

err=3; return; 

elseif lam>=0, 

disp( ’ centers could not find a new feasible controller’) 
break 

elseif (iteration>l ) & (lam>-le-6) , 

disp( ’ feasible set too small to proceed’) 
break 

end 

YW=aff in( [zeros (ma+nq2 ,ma) ,Z] ,xiop,ma) ; 

Y=YW( 1 ;ma, : ) ; W=YW(ma+l :ma+nq2 , : ) ; 
xi=xiop; 

K=W/Y ; 



else , 



Ra-Rl ; 



7 . 

7. defining/solving the min airframe problem 

7 . 

disp( ’Optimizing plant for previous controller’) 
[Tel ,Scl]=h2res2(Aa,Bla,B2a,YW) ; 
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[Tc2 , Sc2] =poleres2(Aa,B2a,rad, alpha, Y , W) ; 

Tc=adiag(Tcl ,Tc2) ; Stac= [Scl ; Sc2] ; 

J=J+0, 1; 

[zetaop, J , st at , err 2] =centers3d(Ta ,Tb , Tc „ Stac ,zeta, J , theta, prec , lel2 ) ; 
if err2"=0 
err=3 ; 
return; 

end 

zeta=zetaop; 

A=af f in(Aa,zeta) ; Bl=aff in(Bla,zeta,nql) ; B2=af f in(B2a,zeta,nq2) ; 

disp( 1 [Margin, Jj = > ) 
disp( [lam, J] ) 

dispC’Closed Loop Poles= , ) 

E=eig(A+B2*K) ; disp(E * ) 

if any (real(E)>=0) , 
err=4 ; 
return 

end 

J2=[J2; lam, J] ; 
if iteration>2, 

if ( J==J2(iteration-l , 2) ) I iteration==100 , 
break 

end 

end 



end 

disp(*Final Closed Loop Poles => ) 

E=eig(A+B2*K) ; 
disp(E) 

loglog(- J2( : , 1 ) , J2( : ,2) , »*») .grid, 

xlabel( * Controller Margin *), ylabel (* Plant Cost 1 ) 

err=0 ; 
return ; 

*/. end plaint opt 8. m 



h2resl 



function [F , Sf , R , Sr] =h2resl (f , AB , C , D , B1B1 ,Z) 

V. 

*/• [F,Sf ,R,Sr]=h2resl(f , AB ,C,D , B1B1 , Z) 

% 

*/, Description: 

*/. 

*/• This function determines the a-matrices of the affine restrictions 



X associated with the generalized H_2 constraint. 

X The input * f* specifies whether the H_2 constraint is to use the 
*/, max eigenvalue (1=2) or the maximum diagonal element (f=3). 

•/. 



y. 

y. 

x 

x 

X 

X 

X 

X 

X 

X 



1) F=AB*YW + (AB*YW)> + B1B1 < 0, 
and 

2a) 1=2: R= I CYC * +DWC * +CW * D * -eye DW | 

I V’D’ -Y I <0 

or 

2b) 1=3: R= I diag(diag(CYC 1 +DWC * +CW *D '-eye) ) DW 

I W ’ D ' -Y 

Note that Y>0 is implicitly enforced within R<0. 



X Inputs: 

X 



*/, AB,C,D,B1B1 parameters of the restriction 
X Z basis for YW from basis2 



X 



X Outputs: 

X 



X F a-matrix of the restriction 
X Sf block structure of F 



<0 



X 

X Comments: 

X 

X Note that in order to obtain the value of the restriction, we need a 
X vector x= [xl , . . . , xr] , then F(x ) =F0+F1 *x 1+ . . . Fr*xr , the block structure 
X of F(x) is Sf . 



[mz ,nz] =size(Z) ; 

[me ,nc] =size (C) ; 

dim=nz/nc; mra-nc+mc ; 

F=zeros(nc ,nc*dim) ; 

R=zeros (mm , nun* dim) ; 

F( : , 1 :nc)=BlBl ; 

R( 1 : me , 1 : me ) =-eye (me ) ; 

for i=l:dim, 

Y=Z(l:nc,(i-l)*nc+l:(i-l)*nc+nc); W=Z(nc+l :mz , ( i-1 ) *nc + l : ( i-1 ) *nc+nc ) ; 
F1=AB* [Y ; W] ; 

DW=D*W ; 

F(: , i*nc+l : (i+1 ) *nc)=Fl+Fl 1 ; 
if f ==3 , 

R( : , i*mm+l : ( i+l)*mm)=[diag(diag(C*Y*C * +DW+C '+C+DV' ) ) ,DV;DV> ,-Y] ; 
elseif f ==2 , 

R( : , i*mm+l: (i+1 )*mm)=[(C*Y*C 1 +DW+C * +C*DW ' ) ,DW;DW ) ,-Y] ; 
else , 

error( , f must equal either 2 or 3 in h2resl') 



end 



end 

SI = [l ,nc] ; 

Sr= [1 ,nc+mc] ; 
return ; 

X end h2resl 



Ii2res2 



function [R , Sf ] =h2res2 ( Aa , Bla , B2a , YW ) 

X 

% [R, Sf ] =h2res2( Aa, Bla, B2a, YW ) 

x 

X Description: 

restriction 



< 0 , 



X and zeta>0 

X 



X This function determines the a-matrix of the convex 

X 

X I AY+B2W+YA * + W ' B2 * B1 I 

X R(zeta) = I I 

X I B1 * - eye I 

X 



X Note that the second part of the H_2 constraint (eye-(C+DK)Y(C+DK) * >0) 
X is independent of zeta! 

X Note also that R(zeta) is independent of the method by which the 
X H-2 constraint is imposed. 

X 

'/. Inputs : 

y. 



'/, Aa,Bla,B2a are a-matrices of the plant 

'/• YW,gam parameters of the restriction (YW is the packed form [Y;W]) 

X 

'/, Outputs: 

X 



'/, R a-matrix of the restriction (-R>0 is actually returned) 
•/. Sf block structure of R 
X 

'/, Comments: 

y. 



X Note that in order to obtain the value of the restriction, we need a 
’/. vector x= [xl , . . . ,xr] , then R(x)=R0+Rl*xl+ . . .Rr*xr , the block structure 
X of R(x) is Sf. 



X 

[ma ,na] =size (Aa) ; 
[mbl , nbl] = size (Bla) ; 
[mb2,nb2]=size(B2a) ; 
dimz=dim- 1 ; 



dim=na/ma; 
nql=nbl/dim; 
nq2=nb2/dim; 
il=dimz+ma+nql ; 
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Fl= [Aa( : , 1 :ma) ,B2a( : , 1 :nq2)] *YW ; 

R=zeros( il ,dim*(il ) ) ; F3=zeros (nql ) ; 

R(dim: il ,dim: il )=- [Fl+Fl * , Bla( : , 1 : nql ) ; Bla( : , 1 : nql ) * , -eye(nql)]; 
for i=l:dimz, 

R(i,i+il*i)=l; 

Fl= [Aa( : , i*ma+l : i*ma+ma) ,B2a( : , i*nq2+l : i*nq2+nq2)] *YW; 

F2=Bla( : , i*nql+l : i*nql+nql ) ; 

R(dim:il,(i*il+dim): (i*il+il))=-[Fl+Fl’ ,F2 ;F2 ’ ,F3] ; 

end 

Sf= [zeros (dimz , 1) ,ones(dimz, 1) ; 1 ,ma+nql] ; 
return ; 

end h2res2 



B. EXAMPLE SCRIPTS 

This section documents the scripts which were used in the preparation of the 
example problems of Chapter V. The principal objective of these scripts is to take 
the linear aerodynamic coefficients and translate them into an open-loop state space 
representation that reflects the dependence on the optimization variables of interests. 
The outputs Aa,Bla,B2a,C and D are then the primary inputs to the optimization 
functions in the section above. The section below follow the order in which the 
examples were introduced in Chapter V. 

1. Example 1- Optimal Vertical Tail at a Single Flight Condition 
This script executes the directional dynamics example illustrated in Chap- 
ter V. The stability derivative data for a F-4 aircraft in the power approach flight 
condition was extracted from [Ref. 37]. The functional dependence of the tail size was 
determined using the relationships in [Ref. 40] to break the stability derivative data 
into its tail and wing/body contributions. The formulae for the plant can be found in 
equations 5.16. This script also provides the plant bases for Example problems 3 and 
4. 
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ft opt lb 



7. Flight condition 1 
7. Approach 

7. Script establishes a directional aircraft plant for 
7. optimization of all-moving vertical tail. 



7. f-4 data 
rho=0. 00238; 7. 

V=230 ; 7. 

Izz= 133700 ; 7. 

S=530 ; 7. 

b=38 . 7 ; 7, 

Sb=243 . 86 ; 7. 

lb=53 . 12 ; 7. 

lt = 19 . 8 ; 7. 

Tmax = 20000; 
le = 2.0; 
umax = 30/57.3; 



slugs/ft~3 

fps 

slug-f t~2 



ft~2 

ft 

ft~2 

ft 

ft 



wing area 

wing spam 

body surface area 

body length 

tail position from eg 



Cnbwb=-0. 00107; 
Cybt=0 . 425 ; 



7* yaw moment due to beta (wing/body) 
7* side force due to beta (tail) 



q=0 . 5*rho* V*V ; 7. lbf/ft~2 

sigmabeta=0 . 043 ; 7. variance on disturbance 



7. build functional state-space representation 
A0= [0 1 ; -Izz\q*S*b*Cnbwb -Izz\2*q*S*b* (lt/V) *Cnbwb] ; 
A 1= [0 0 ; -Izz\q*S*b*Cybt -Izz\2*q*S*b* (lt/V) *Cybt] ; 
Aa= [A0 Al] ; 



B10= [0 -Izz\q*S*b*Cnbwb] * ; 

B1 1= [0 -Izz\q*S*b*Cybt] * ; 

Bla=[B10 B1 l] ♦sigmabeta ; 

B20= [0 0] ’ ; 

B21= [0 -Izz\q*S*b*Cybt] * ; 

B2a= [B20 B21] ; 

7* initial parameters 

Vto=0.47; 7. original tail volume 

Vro=0.3*Vto; 7. original relative rudder volume 

zeta= [Vto ] J ; 
weight= [1 ] ; 

7. original dynamics 
Ao=af f in( Aa , zeta) ; 

B2o=aff in(B2a,zeta, 1) ; 

7* sigmabeta is variance on beta disturbances 
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Bl= [0 ; -Izz\q*S*b* (Cnbwb+Cybt*Vto )] *sigmabeta ; 

C= [1/0 . 035 0; 0 0]; 

D=[0; 1/0. 175] ; 

DRdyn=eig(Ao) ; 

nat_f rq=abs (DRdyn( 1 ) ) ; 

damping=-cos(angle(DRdyn(l)) ) ; 

*/, Construct the basis lor the static moment problem (example 4) 
Do = -Tmax*le; 

D1 = q*S*b*Cybt*umax ; 

Da = [Do ,Dl] ; 

'/. end F4_opt_lb 



2. Example 2- Optimal Vertical Tail at Multiple Flight Conditions 

The following two scripts prepared the vertical tail optimization problem 
at high subsonic and supersonic flight conditions. These were then used in concert 
with the script in the above slow speed script to perform the multiple flight condi- 
tion example problem. The synthesis model is different from the script above in two 
respects. First of alb the stability derivatives reflect the values appropriate to the 
various flight conditions. Secondly, the turbulence rejection specification is signifi- 
cantly different, and required different scaling of the input and output vectors w and 
z. Scaling of w was reflected in the C and D mat rices, while scaling of ir was reflected 
in the B\ and D matrices. 
f4 opt 2b. m 



'/, Flight condition 2 
'/, Subsonic cruise 

'/, Script establishes a directional aircraft plant for vertical optimization. 
’/. f-4 data 

rho=0. 000739; */. slugs/ft‘3 

V=876; */. fps 

Izz=139800 ; ’/. slug-ft*2 

S=530; */. ft*2 



wing area 



b=38 . 7 ; •/. ft w: 

Sb=243 . 86 ; */. ft~2 b< 

lb=53.12; */, ft body length 

lt=19.8; */, ft t; 



wing span 

body surface area 



tail position from eg 



Cnbwb=-0. 00125; 
Cybt=0 . 266 ; 



*/, yaw moment due to beta (wing/body) 
% side force due to beta (tail) 



q=0.5*rho*V*V; */. lbf/ft~2 



sigmabeta=0 . 0057 ; */. variance on disturbance 

X build functional state-space representation 

A0= [0 1 ;-Izz\q*S*b*Cnbwb -Izz\2*q*S*b* (lt/V) *Cnbwb] ; 

Al= CO 0;-Izz\q*S*b*Cybt -Izz\2*q*S*b* (lt/V)*Cybt] ; 

Aa2=[A0 Al] ; 

B10= [0 -Izz\q*S*b*Cnbwb] * ; 

B1 1= [0 -Izz\q*S*b*Cybt] * ; 

Bla2=[B10 B1 l] *sigmabeta ; 

B20= [0 0] ' ; 

B21=[0 -Izz\q*S*b*Cybt] 1 ; 

B2a2= [B20 B21] ; 

*/. initial parameters 

Vto=0.47; */, original tail volume 

Vro=0.3*Vto; */. original relative rudder volume 

zeta= [Vto ] * ; 
weight= [1 ] ; 

*/. sigmabeta is variance on beta disturbances 
Bl = [0 ; -Izz\q*S*b*(Cnbwb+Cybt*Vto)] ♦sigmabeta; 

C=[l/0.035 0; 0 0]; */, weights rms beta to be less than 2 deg 

D= [0 ; 1/0 . 175] ; */, weights rms rudder deflection to be less than 10 deg 

fl opt 3b, m 

*/. Flight condition 3 
*/, Supersonic cruise 

*/. Script establishes a directional aircraft plant for vertical tail optimization, 
y. f-4 data 

rho=0. 000287; % slugs/ft~3 



V=1742 ; 
Izz=139800 ; 
S=530 ; 
b=38 . 7 ; 
Sb=243 . 86 ; 
lb=53 . 12; 
lt=19 . 8 ; 



y. fps 



y. siug-f t“2 



•/. ft “2 
•/. ft 
•/. ft “2 



wing area 
wing span 
body surface area 



*/. ft body length 
•/. ft 



tail position from eg 



Cnbwb=-0. 00133; 
Cybt=0. 193; 



'/, yaw moment due to beta (uing/body) 
'/, side force due to beta (tail) 



q=0.5*rho*V*V; '/. lbf/ft~2 

sigmabeta=0 . 0029 ; */, variance on disturbance 

'/, build functional state-space representation 

A0= [0 1 ; -Izz\q*S*b*Cnbwb -Izz\2*q*S*b* (lt/V) *Cnbwb] ; 

Al= [0 0;-Izz\q*S*b*Cybt -Izz\2*q*S*b* (lt/V) *Cybt] ; 

Aa3= [A0 A1 ] ; 

B10= [0 -Izz\q*S*b*Cnbwb] 1 ; 

B1 1 = [0 -Izz\q*S*b*Cybt] * ; 

Bla3=[B10 B1 l] ♦sigraabeta; 

B20= [0 0] ’ ; 

B21= [0 -Izz\q*S*b*Cybt] * ; 

B2a3= [B20 B2l] ; 

*i initial parameters 

Vto=0.47; '/, original tail volume 

Vro=0.3*Vto; '/, original relative rudder volume 

zeta= [Vto] ’ ; 
weight= [l ] ; 

'/« sigmabeta is variance on beta disturbances 
B 1= [0 ; -Izz\q*S*b*(Cnbub+Cybt*Vto)] * sigmabeta; 

C=[l/0.035 0; 0 0]; '/* weights rms beta to be less than 2 deg 

D= [0 ; 1/0 . 17S] ; '/, weights rms rudder deflection to be less than 10 deg 



3. Example Three- Optimal Vertical Tail for Joint 7 Pole-Placement 
Specification 

The Joint Pole-Placement example problem used the identical set up 
script as example one above. The difference was that a different optimization function 
code was exercised (plantop6 for the joint constraint in lieu of plantopt2 for the 
pure constraint). 
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4. Example Four- Optimal Vertical Tail for Joint Hoo Static Moment 

Specification 

Example Four used the identical set up script as example one above. The 
difference was that a different optimization function code was exercised (plantop2a 
for the joint constraint in lieu of plantopt2 for the pure 'H 00 constraint). 

5. Example Five/Six- Plant and Controller Optimization with Ma- 
neuvering Constraints 

The following script creates the bases for the longitudinal F-14 autoland 
problem. The aerodynamic derivative data was extracted from [Ref. 48], and the 
decomposition into the wing/body and horizontal tail contributions is in accordance 
with [Ref. 40]. The coding of the flight dynamics equations was verified by a cross 
check of the nominal plant (( = [1, \] T ) with a linear plant extracted from a lin- 
earization of the nonlinear equations used for the design examples of Chapter IV. 
This routine does provide the bases for uncertainty modeling, though this was not 
successfully demonstrated in an example problem. 

This model does not include actuator dynamics. Predecessors did include 
actuator dynamics, but problems were encountered in solving the initial feasibility 
problem using either Riccati or interior point methods. These problems were at- 
tributed to the stiff geometry that the actuator poles introduced. See the script for 
further comments regarding its use. 

The plant optimization function plantopt2 was used for Example Five, 
while plantopt2a was used for Example Six. In the later two cases, the maneu- 
verability constraint was passed into the optimization function through the input 



variable Da. 



One aspect of this physical example is contrived. Specifically, the thrust 
was fixed for the problem and not used as a control input. This was necessary in 
the absence of actuator models, for otherwise the opt imization routine shifted all the 
control energy into thrust in order to collapse the aerodynamic surface sizes. 

An important practical issue relevant to the subject of the general prob- 
lem's geometry was observed during these experiments. The method of centers code 
centers3 has a numerical input argument prec which determines the termination 
criteria for the Newton search for the analytic center. It essentially determines how 
deep the search must go before it is considered to be "‘close enough" to the optimal 
value. In a strictly affine problem prec is related to t he precision of the final output 
relative to the optimal value. The default for this value had been set to 10“ 3 , which 
would ensure that the output was within O.lof the optimal value. Because of our 
methodology in employing the method of centers in alternating directions across the 
feasible set, this was no longer true. The output for the above problems could vary 
as much as a factor of 20 if prec was not set low enough. As prec was adjusted 
from 10“ 3 to 10“ 6 , the total cost at the conclusion of one set of trials improved by 
a factor of nearly 20. No further improvement was then noted as prec was adjusted 
from 10“ 6 to 10“ 9 . 
f 1 4 opt 3.m 

*/. Establishes plant matrices for flight path control problem with 
% stab and DLC control power adjustable. 

*/. Thrust and actuators have been removed. 

*/. This problem is hinf feasible, but not jointly hinf and pole-placement 
*/♦ feasible for (87.3,1) circle. 

*/, Converges successfully with plantopt2 (hinf only) . 

*/. The precision argument for plantopt2 must be set to le-6 or smaller 
'/, to find the feasible controller. 



g=32.174; 

m=54000/g; 

Iyy=247 194 ; 

S=565 ; 
cbar=9 . 8 ; 

U=134*l . 6889 ; 

M= . 203 ; 

p=21 16 ; 

Q= . 7*p*M*M ; 
alpha=l 1.4/57. 3; 
u0=cos (alpha) *U ; 
th0=alpha; 
s igma_cmd=3/57 . 3 ; 
s igma_alpha=5/U ; 
omegal=40 ; 
omega2=80 ; 
omega3=5 ; 
rhol=0 . 1 ; 
rho2=0 ; 



7. f ps 
'/. slugs 
7. slug-f t "2 
7. ft' "2 

7. ft 

7. fps 

7. lbf /f t "2 
7. lbf/ft~2 
7. rad 

’/, rad - trim point is level flight 
7. rad 
7. rad 

7. rad/s - Actuator bandwidths 
7. rad/s 
7. rad/s 

7. DLC drag to lift ratio 
7. DLC moment to lift ratio 



7. F-14 stability derivative 
CLt=l. 49534913; 

CDt=0. 37405269; 

CMt=0 ; 

CDU=0 ; 

CLU=0 ; 

CMU=0 ; 



CDA=0. 0208*57. 3; 7. 
CLA=0. 0799*57. 3; 7. 
CMA=-0 .0115*57.3; 7. 
CLQ=5 . 45 ; 7. 
CMQ=-14 . 3 ; 7. 
CLAD=-0 . 51 ; 7. 
CMAD=-0 . 93 ; 7. 



data 



rad"- 1 
rad"- 1 
rad"- 1 
rad"-l 
rad"-l 
rad"-l 
rad"-l 



CLIS=0. 0141*57. 3; 7. rad"-l 

CMIS=-0. 0201*57. 3; 7. rad"-l 



7. Scale initial DLC for -0.1 g accel at full deflection of 0.5 rad 
CLDLC=-0 . l*CLt/0.5; 7. rad"-l 

CDDLC=rhol*CLDLC ; 7. rad"-l 

CMDLC=rho2*CLDLC ; 

7. Determine the wing body derivatives: 

xc=-CMIS/CLIS ; 7. ratio of tail lever arm to mean chord 

CDAwb=CDA ; 

CLAwb=CLA-CLIS ; 

CMAwb=CMA-xc*CLIS ; 

CLQwb=CLQ-2*xc*CLIS ; 

CMQwb=CMQ+2*xc"2*CLIS ; 

CLADwb=CLAD+2*xc*CLIS ; 



CMADwb=CMAD-2*xc~2*CLIS; 



*/, determine Rotation Matrix from Lift/Drag to body axis 

T= [-cos (alpha) sin(alpha) 0 ; -sin(alpha) -cos(alpha) 0;0 0 cbar] ; 

QT=Q*S*T ; 
c2U=cbar/2/U ; 

'/. Determine Corrected Inertia Matrix 

J=diag([m*U,m*U,Iyy,l])-[c2U*QT*[0 0 0;0 CLAD 0;0 CMAD 0 ],[0;0;0];0 000]; 

'/. Build aero blocks of state matrices 

'/, states are u , alpha, q , theta , alpha/s ,gamma_er/s 

a00= [2*CDt -CLt 0;2*CLt CDt 0; 2*CMt 0 0]; 

a01= [CDU/U CDAwb 0; CLU/U CLAwb CLQvb*c2U ; CMU/U CMAwb CMQvb*c2U] ; 
a0= [QT* (aOO+aOl ) ,-m*g* [cos(thO) ;sin(thO) ; 0] ; 00 1 0]; 
aO(l : 2 , 3) =m*U* [-sin (alpha) ; cos (alpha)] +a0( 1 :2,3) ; 

al= [QT+CLIS* [0 0 0;0 1 2*xc*c2U; 0 xc -2*xc ~2*c2U] , [0 ; 0 ; 0] ; 0 000]; 
a2=zeros (4,4) ; 

aO=J\aO; al=J\al; 

'/, control inputs are stab(rad) , DLC (rad), thrust(lbf) 
b0=zeros(4 ,2) ; 

bl= J\ [QT* [0 0 ; CLIS 0;CMIS 0];0 0]; 
b2=J\[QT*[0 CDDLC ; 0 CLDLC ;0 CMDLC ];0 0 ]; 

*/, Build system matrices 
A0=zeros (6 , 6) ; A1=A0; A2=A0; 

AO ( 1 : 4 , 1 : 4 ) =a0 ; A 1 ( 1 : 4 , 1 : 4 ) =al ; A2( 1 : 4 , 1 : 4) =a2 ; 

A0(5 , 2) =1 ; 

A0(6, [2,4] ) = [-l 1] ; 

Aa= [AO A 1 A2] ; 

'/, exogenous inputs alpha_dist, gamma_cmd 
B10= zeros (6 , 2) ; B11=B10; B12=B10; 

BIO ( 1:4, l)=aO( ; , 2) *sigma_alpha ; BIO (6 , 2) =“sigma_cmd ; 

B1 1(1:4, l)=al( : , 2) *sigma_alpha ; 

B12 ( 1 : 4 , 1 ) =a2( : , 2) *s igma_ alpha ; 

Bla= [BIO BU B12] ; 

B20= [bO; 0 0 ; 0 0]; B21=[bl; zeros(2,2)]; B22=[b2; zeros(2,2)]; 

B2a=[B20 B21 B22] ; '/, factor required to achieve hinf feasibility 

*/* Build Output matrices 

y. 

'/, z= [stab, DLC , alpha/s ,gamma_err/s , alpha] 

7 . 



C=zeros(5,6) ; Dl=zeros(5 , 2) ; D2=eye(5,2) ; 

C(3:4,5:6)=eye(2); 

C(5,2)=l; 

*/, Output criteria: 

*/♦ stab<20 deg 
*/, DLC <40 deg 
*/, alpha_err< 1.5 deg 

zScale=diag( [57 . 3/20 , 57 . 3/40 , . 00001 , .00001 , 57.3/1.5]); 

C=zScale*C; Dl=zScale*Dl ; D2=zScale*D2 ; 

zeta=[lO; 10] ; 
wgt= [3 , 1] ; 

*/, Build system matrices for uncertainty inputs and outputs 
Delta=0 . l*eye (6 , 3) ; */* Scaling for 10*/, uncertainty 

B3=Delta*QT ; 

C3_0=QT\ J (1:3,1: 3) \QT* [aO 1 , zeros (3 , 3 )] ; 

C3_l=[QT\al(l:3, :) ,zeros(3,2)] ; 

C3a=[C3_0,C3_l , zeros (3 ,6)] ; 

D3a=QT\B2a(l:3,:); 

*/, Add open loop requirement to maintain a max neg. pitch rate 
*/* of 0.2 rad/sec for elev. deflection from trim of -20 deg 

de_max = -20; 
q_max = 0.2; 

E0 = A0 (3 , 3) *q_max + B20(3 , 1 ) *de_max/57 . 3 ; 

El = Al(3 ,3)*q_max + B21 (3 , 1 ) *de„max/57 . 3 ; 

E2 = 0; 

Ea = [E0 El E2] ; 



*/, end f!4_opt_3 



6. Example Seven- Plant and Controller Optimization with Maneu- 
vering Constraints and Directed Thrust 

The following script is nearly identical to the script above, with the excep- 
tion of the inclusion of directed thrust. The directed thrust shows up principally in 
the Z?2 matrix where it influences both the closed-loop controller, and the open-loop 
maneuverability constraint. The maneuverability specification is identical to that 



258 



applied for Example Six. 
f 14 opt 4 



'/. Establishes plant matrices for flight path control problem with 
'/. stab and DLC control power adjustable. 

*/, Thrust and actuators have been removed. 

'/, This problem is hinf feasible , but not jointly hinf and pole-placement 
'/. feasible for (87.3,1) circle. 

'/. Converges successfully with plantopt2 (hinf only). 

'/, The precision argument for plantopt2 must be set to le-6 or smaller 
'/, to find the feasible controller. 



g=32. 174; 
m=54000/g ; 
Iyy=247194 ; 

S=565 ; 
cbar=9 . 8 ; 

U=134*l . 6889 ; 

M= . 203 ; 

p=2 1 16 ; 

Q= . 7 *p*M*M ; 
alpha=l 1 . 4/57 . 3 ; 
u0= cos (alpha) *U; 
th0=alpha ; 
sigma_cmd=3/57 . 3 ; 
sigma_alpha=5/U ; 
omegal=40 ; 
omega2=80 ; 
omega3=5 ; 
rhol=0 . 1 ; 
rho2=0 ; 



'/♦ fps 
'/. slugs 
'/. slug-f t "2 
V. ft “2 

•/. ft 

y. fps 

•/. lbf / ft "2 

y. lbf /ft “ 2 

'/. rad 

'/, rad - trim point is level flight 
*/. rad 
*/. rad 

'/, rad/s - Actuator bandwidths 
*/, rad/s 
*/, rad/s 

*/, DLC drag to lift ratio 
'/, DLC moment to lift ratio 



'/, F-14 stability derivative 
CLt=l. 49534913; 

CDt=0. 37405269; 

CMt=0 ; 

CDU=0 ; 

CLU=0 ; 

CMU=0 ; 



CDA=0. 0208*57. 3; */. 
CLA=0 .0799 + 57.3; '/. 
CMA=-0. 0115*57. 3; ’/, 
CLQ=5 . 45 ; */. 
CMQ=-14.3; */. 
CLAD=-0 . 51 ; */, 
CMAD=-0 . 93 ; */, 



data 



rad“ - 1 
rad" - 1 
rad ~ - 1 
rad" - 1 
rad~-l 
rad" - 1 
rad"- 1 



CLIS=0. 0141*57. 3; ’/. rad"-l 



CMIS=-0. 0201*57. 3; 



*/, rad~- 1 



*/, Scale initial DLC lor -0.1 g accel at full deflection of 0.5 rad 
CLDLC=-0. l*CLt/0 .5 ; Y. rad~-l 

CDDLC=rhol*CLDLC ; Y. rad*-l 

CMDLC=rho2*CLDLC ; 

*/, Determine the wing body derivatives: 

xc=-CMIS/CLIS ; '/, ratio of tail lever arm to mean chord 

CDAwb=CDA ; 

CLAwb=CLA-CLIS ; 

CMAwb=CMA-xc*CLIS ; 

CLQwb=CLQ-2*xc*CLIS ; 

CMQwb=CMQ+2*xc~2*CLIS ; 

CLADwb=CLAD+2*xc*CLIS ; 

CMADwb=CMAD-2*xc~2*CLIS ; 

*/. determine Rotation Matrix from Lift/Drag to body axis 
T= [-cos(alpha) sin(alpha) 0 ; -sin(alpha) -cos(alpha) 0;0 0 cbar] ; 

QT=Q*S*T ; 
c2U=cbar/2/U ; 

'/, Determine Corrected Inertia Matrix 

J=diag([m*U,m*U,Iyy , l] )- [c2U*QT* [0 0 0;0 CLAD 0;0 CMAD 0 ],[0;0;0];0 0 0 0] 

'/, Build aero blocks of state matrices 

'/, states are u, alpha ,q, theta, alpha/s, gamma_er/s 

a00= [2*CDt -CLt 0;2*CLt CDt 0; 2*CMt 0 0]; 

a01= [CDU/U CDAwb 0; CLU/U CLAwb CLQwb*c2U ; CMU/U CMAwb CMQwb*c2U] ; 
a0=[QT*(a00+a01) , -m*g* [cos(thO) ;sin(th0) ; 0] ; 00 1 0]; 
a0(l : 2,3) =m*U* [-sin (alpha) ; cos (alpha)] +a0( 1 :2,3) ; 

al= [QT*CLIS* [0 0 0;0 1 2*xc*c2U; 0 xc -2*xc‘2*c2U] , [0 ; 0 ; 0] ; 0 0 0 0]; 
a2=zeros(4 ,4 ) ; 

a0=J\a0; al=J\al; 

Y% control inputs are stab(rad) , DLC (rad), thrust(lbf) 
b0=zeros(4 ,2) ; 

bl= J\ [QT* [0 0 ; CLIS 0;CMIS 0] ;0 0]; 

b2= J\ [QT* [0 CDDLC ; 0 CLDLC ;0 CMDLC ];0 0 ]; 

*/, create directed thrust control input 
TO = 13118; 
thetaeO = 0/57.3; 

Px = xc + 3; */, thrust lever arm 

Bdt = zeros (6 , 1 ) ; 

Bdt(l) = -T0*sin(thetae0)/m; 

Bdt(2) = -T0*cos (thetaeO)/(m*U) ; 

Bdt(3) = -Px*T0*cos (thetaeO) /m ; 

*/, Build system matrices 
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A0=zeros(6 , 6) ; A1=A0; A2=A0; 



A0( 1 : 4 , 1 : 4)=a0 ; A1 ( 1 : 4 , 1 : 4)=al ; A2(l:4,l:4)=a2 

A0(5,2)=l; 

A0(6 , [2 ,4] ) = [-1 1] ; 

Aa= [AO A1 A2] ; 

7. exogenous inputs alpha_dist, gamma_cmd 
B10= zeros(6,2) ; B11=B10; B12=B10; 

B10(l:4,l)=a0(: , 2)*sigma_alpha; B10(6,2)=-sigma_cmd; 

Bll(l:4,l)=al(: ,2)*sigma_alpha; 

B 1 2 C 1 :4, l)=a2( : , 2)*sigma_alpha; 

Bla= [BIO B 1 1 B12] ; 

B20= [bO; 0 0;0 0] ; 

B20( : ,1) = B20( : ,l) + Bdt ; 

B21=[bl; zeros(2,2)]; 

B22=[b2; zeros(2,2)] ; 

B2a=[B20 B21 B22] ; 7. factor required to achieve hinf feasibility 

V, Build Output matrices 

7. 

7, z= [stab ,DLC , alpha/s ,gamma_err/s , alpha] 

7. 

C=zeros(5 , 6) ; Dl=zeros(5,2) ; D2=eye(5,2); 

C(3:4,5:6)=eye(2); 

C(5,2)=l ; 

7. Output criteria: 

7. stab<20 deg 
7. DLC <40 deg 
7. alpha_err< 1.5 deg 

zScale=diag( [57 . 3/20 , 57 . 3/40 , . 0000 1 . . 00001 , 57.3/1.5]); 

C=zScale*C; Dl=zScale*Dl ; D2=zScale*D2 ; 

zeta= [10 ; 10] ; 
wgt= [3 , 1] ; 

7. Build system matrices for uncertainty inputs and outputs 
Delta=0. l*eye(6,3) ; 7. Scaling for 107. uncertainty 

B3=Delta*QT ; 

C3_0=QT\J (1:3,1: 3)\QT* [aOl .zeros (3 ,3)] ; 

C3_l= [QT\al ( 1:3,:) .zeros (3 ,2)] ; 

C3a= [C3_0 , C3_l , zeros ( 3,6)] ; 

D3a=QT\B2a( 1 : 3 , : ) ; 



261 



'/. Add open loop requirement to maintain a max neg. pitch rate 
'/, of 0.5 rad/sec for elev. deflection from trim of -20 deg 
'/, and a thrust deflection of 6 degrees at 20 Klbs 

de_max = -20; 
q_max = . 5 ; 
thetae_max = -20; 

E0 = A0(3 , 3) *q_max + B20(3 , l)*de_max/57 . 3 + Bdt (3)*thetae_max/57 . 3; 

El = Al(3,3)*q_max + B21 (3 , 1 )*de_max/57 . 3 ; 

E2 = 0; 

Ea = [E0 El E2] ; 

theta = 0.1; gam = 1; prec = le-6; thres = le-9; 

[z2 , xi ,K ,Z , Rc ,Tc , J2 , err] =plantopt2a( Aa , Bla, B2a ,C ,D2, Ea ,zeta ,wgt , thres , gam, theta , prec) 
'/, end f!4_opt_4 
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